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ABSTRACT 


Recent  interest  in  positioning  cruise  missile  flight 
control  surfaces  using  electromechanical  actuation  has 
prompted  a  detailed  study  of  brushless  dc  motor  performance 
in  such  an  application.  While  the  superior  response 
characteristics  of  these  electronically  commutated  motors 
are  particularly  well  suited  to  unidirectional  velocity 
drives,  destructive  electrical  transients  associated  with 
rotational  reversals  of  the  motor  limit  its  positioning 
performance.  This  thesis  involves  computer  aided  design  of 
a  functionally  robust  brushless  dc  motor  position 
controller  using  pulse  width  modulation.  Lumped  parameter 
model  simulation  and  phase  plane  analysis  were  performed  to 
attain  a  preliminary  parametric  design  of  the  controller. 
Comprehensive  electrical  and  mechanical  analyses  were 
conducted  using  detailed  model  simulation  to  arrive  at  the 
final  design  by  parametric  optimization.  FORTRAN  source 
code  listings  for  all  simulations  discussed  in  this  thesis 
are  appended  and  were  run  on  a  personal  computer. 
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I.  INTRODUCTION 


A .  BACKGROUND 

The  ever  increasing  demand  for  small,  high  performance 
motors  for  use  in  such  applications  as  missile  flight  and 
space' vehicle  control  actuators,  robotics,  and  disk  drives, 
justify  development  of  brushless  dc  motor  technology. 

Although  conventional  dc  motors  are  highly  efficient 
and  are  proven  to  be  well  suited  for  servo  motor 
application,  brushless  dc  motors  are  generally  superior  in 
performance.  Perhaps  the  most  significant  factor  in  the 
recognition  of  the  permanent  magnet  dc  motor  as  a  viable 
electro-mechanical  actuator  is  the  recent  advances  made  in 
the  area  of  rare-earth  magnetic  materials.  Despite  the 
increased  initial  cost  of  samarium-cobalt,  for  example,  its 
characteristically  high  magnetic  remanence  and  coercive 
force  provide  about  twice  the  flux  density  of  a  similar 
ferrite  magnet.  The  increased  torque-to-inertia  ratio  is 
desired  in  high  performance  actuators.  Additionally, 
improvements  in  semiconductor  technology  have  further 
enhanced  the  realization  of  electronic  commutation.  Rapid 
switching  characteristics  and  low  power  consumption  of  solid 
state  devices  have  widened  the  gap  in  performance  between 
brushless  and  conventional  dc  motors.  Field  windings  of  a 
brushless  dc  motor  are  located  in  the  stator  with  permanent 


13 


magnet  in  the  rotor  and  commutation  is  performed  using 
solid  state  devices,  resulting  in  cooler  motor  operations. 
Inherent  to  the  removal  of  mechanical  brushes  and 
commutators  is  the  elimination  of  arcing  and  general 
maintenance  associated  with  conventional  dc  motors.  The 
physical  separation  of  commutation  electronics  and  the  motor 
provide  for  a  much  smaller  actuator,  capable  of  funct Toning 
in  areas  previously  thought  to  be  too  restrictive  for 
electro-mechanical  actuation. 

B .  PURPOSE 

Although  application  of  brushless  dc  motors  is  rapidly 
expanding,  their  popular  use  is  inhibited  by  the  requirement 
for  relatively  complex  control  and  power  conditioning 
electronic  circuitry.  The  intrinsic  high  performance 
characteristics  of  these  electronically  commutated  motors 
are  particularly  well  suited  to  velocity  devices,  where  the 
direction  of  rotation  is  not  routinely  reversed.  Thus, 
recent  exploitation  has  been  primarily  confined  to  variable 
speed  drives.  The  intent  of  this  study,  however,  is  to 
design  a  functionally  robust  positioning  device  capable  of 
cruise  missile  fin  actuation  over  a  broad  range  of  missile 
flight  dynamics. 

Unlike  the  unidirectional  kinematics  associated  with 
velocity  controlled  motors,  positioning  response  is 
invariably  characterized  by  rotational  reversals.  While  the 


superior  torquing  capability  of  brushless  dc  motors  supports 
high  performance  position  control,  the  electronic  components 
which  facilitate  commutation  are  subjected  to  excessive 
voltage  transients  and,  hence,  reduced  operational 
reliability.  The  central  theme  of  this  study  involves  the 
design  compromises  required  between  system  performance  and 
corresponding  electrical  characteristics. 

C .  APPROACH 

Graphic  techniques  employed  in  this  thesis  are 
supported  by  a  variety  of  interactive  computer  aided  design 
developed  specifically  for  studying  the  behavior  of 
brushless  dc  motors.  Previous  efforts  by  Thomas  [Ref.l]  and 
MacMillan  [Ref. 2]  using  the  IBM  370  mainframe  compiler  serve 
as  a  foundation  from  which  this  study  stems.  All  simulation 
is  performed  on  a  microcomputer  rather  than  the  IBM  370 
mainframe,  and  lower  level  programming  in  FORTRAN 7 7  replaces 
the  Continuous  System  Modeling  Program  (CSMP)  language 
[Ref. 3].  While  CSMP  provides  an  excellent  environment  for 
general  simulation,  it  impedes  programming  accessibility  to 
various  structural  mechanisms  and  primarily  provides  output 
characteristics  of  imbedded  functions.  Along  with  enhancing 
process  visibility,  coding  in  FORTRAN  facilitates  program 
portability.  An  objective  of  this  thesis  is  delivery  of 
appropriate  design  tools  to  support  on-going  efforts  in 


brushless  dc  motor  development  at  Naval  Weapons  Center 
(NWC) ,  China  Lake. 

Correlation  between  electrical  and  mechanical  response 
characteristics  of  brushless  dc  motors  is  prerequisite  to 
the  design  problem  and  best  determined  with  the  motor 
configured  as  an  open  loop  velocity  device.  Power 
conditioner  modifications  which  reduce  high  voltage 
transients  are  investigated.  Pulse  width  modulation  is 
examined  as  a  method  for  providing  accurate  position  control 
in  a  manner  congruous  with  power  conditioner  electronic 
limitations. 

Optimal  selection  of  design  parameters  cannot  readily 
be  made  with  the  detailed  model  of  MacMillan  due  to  the 
degree  of  its  complexity.  Therefore,  preliminary  design  is 
accomplished  using  lumped  parameter  modeling  which  provides 
simulation  simplicity,  speed,  and  insight.  Additionally, 
with  limited  availability  of  manufacturer's  and  experimental 
performance  data,  which  is  summarized  in  [Refs.4&5],  the 
simplified  model  provides  an  excellent  means  of  validation 
and  verification  of  the  brushless  dc  motor  simulation. 

Phase  plane  methods  used  in  this  study  support  the 
graphic  nature  of  nonlinear  design  and  provide  considerable 
insight  not  only  to  system  performance,  but  also  to  the 
motor's  dynamics.  The  culmination  of  this  study  involves 


Previous  efforts  in  brushless  dc  motor  simulation  at 
NPS  have  exploited  the  IBM  370  mainframe  and  Continuous 
System  Modeling  Program  (CSMP) .  Significant  attractions  of 
these  assets  include  programming  simplicity  and 
computational  versatility  due  mostly  to  stiff  integration 
methods  available.  However,  current  microprocessor 
capabilities  justify  the  development  of  such  a  simulation 
for  analysis  on  a  personal  computer. 

The  programming  language  chosen  for  this  undertaking  is 
Microsoft  FORTRAN77  V3.31.  Graphic  output  is  attained  via 
subroutine  calls  to  Plotworks  PLOTS 8  graphics  library. 
Because  of  the  intense  computational  demand  of  the 
simulation,  an  INTEL  8087  numeric  co-processor  was 
exploited. 

The  motivation  for  conducting  such  a  study  on  a 
personal  computer  lies  in  the  inherent  portability  of  the 
product.  On-going  efforts  at  NWC,  China  Lake  in  brushless 
dc  motor  design  and  analysis  are  not  fully  benefited  by 
present  NPS  computer  simulations  because  of  mainframe 
inaccessibility.  Additionally,  batch  processing  of  CSMP 


simulation  results  in  cumbersome  development  of  the  model. 
While  microprocessor  architecture  lacks  the  computational 


power  of  the  mainframe,  it  is  superior  in  terms  of 
portability  and  work  station  availability.  All  simulations 
conducted  in  this  study  were  performed  on  INTEL  8088/8086 
machines,  although  the  universal  nature  of  FORTRAN  coding 
could  be  easily  implemented  on  any  machine  capable  of  being 
programmed  in  FORTRAN.  The  source  code  for  the  detailed 
brushless  dc  motor  simulation  program  is  listed  in  Appendix 


The  basic  modeling  structure  delineated  in  MacMillan's 
work  [Ref. 2]  is  illustrated  in  Figure  2.1  and  serves  as  the 
starting  point  of  this  study.  Based  on  the  assumption  that 
the  network  is  balanced  and  the  power  supply  configuration 
is  split,  the  relatively  complex  3-phase  bridge  circuit 
shown  in  Figure  2.2  simplifies  into  the  two  window  network 
of  Figure  2.3  [Ref.4].  Back  emf  voltage  of  each  phase  is 
modeled  by  MacMillan  and  summed  two  at  a  time  to  determine 
loop  currents.  Reference  2  gives  a  detailed  development  of 
the  power  conditioner  model  which  includes  assumptions  for 
the  switching  transistor  dynamics  used  in  commutation  as 
well  as  the  development  of  the  harmonic  air-gap  flux  used  in 
the  motor  model. 


B.  SIMULATION  METHOD 


Since  the  simulation  environment  intrinsic  to  CSMP  is 
not  available  in  FORTRAN,  a  viable  means  of  dynamic 
programming  was  devised.  Natural  parallel  processing 
observed  in  the  behavior  of  electronic  components  of  the 
motor  is  simulated  using  iterative  numerical  techniques. 

Continuous  system  modeling  is  attained  via  the  dynamic 
solution  of  two  nested  systems  of  coupled,  nonlinear 
differential  equations.  The  inner  loop  establishes 
incremental  states  of  motor  current.  Using  Thevenin 
equivalence  techniques,  potential  is  applied  across 
nonlinear  resistance.  This  resistance  is  dependent  upon  the 
state  of  diodes  and  transistors,  as  well  as  the  linear 
resistance  of  the  phase  windings.  An  adaptive  Newton-like 
method  for  solving  these  equations  was  developed.  Of 
particular  interest  in  the  inner  loop  is  the  presence  of 
multiple  solutions,  where  lax  iterative  methods  could  result 
in  convergence  to  an  incorrect  solution.  Specifically,  the 
parallel  relationship  between  the  nonlinear  equivalent 
resistance  and  motor  phase  current  allow  for  convergence  to 
either  the  low  or  high  diode  resistance  solution.  This  is 
particularly  prevalent  during  periods  of  diode  free-wheeling 
associated  with  commutation  switching.  The  numerical 
solution  of  the  inner  system  of  coupled  equations  becomes 
extremely  stiff  and  voltage  sensitive  near  the  bias 
threshold  of  the  protective  diode.  A  quantized  two-state 
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solution  exists  over  a  narrow  range  of  inputs,  resulting  in 
somewhat  unpredictable  numerical  convergence  and  possible 
local  instability.  One  solution  for  phase  current 
incorporates  a  relatively  fast  time  constant  due  to  the  high 
equivalent  resistance  contributed  by  the  non-conducting 
diode,  while  the  conducting  diode  solution  is  described  by  a 
slower  time  constant. 

The  stiff  characteristics  of  the  inner  loop  are 
adequately  handled  through  the  use  of  a  cautious  iterative 
method  which  is  invoked  prior  to  numerical  bracketing  of  the 
actual  solution.  During  non-bracketed  iterations,  the 
simulation  step  is  halved  and  the  system's  condition  is 
investigated  to  ensure  that  the  solution  has  not  been 
bypassed.  This  halving  technique  increases  the  resolution 
of  the  high/low  resistance  solutions  which  might  otherwise 
mask  each  other.  This  method  works  reasonably  well,  but 
numerical  "chattering”  is  still  observed  during  conditions 
immediately  prior  to  diode  turn-off.  Although  available 
stiff  integration  methods  would  further  minimize  the 
numerical  oscillation,  size  and  speed  constraints  prohibit 
such  integration  in  this  program. 

The  outer  loop  solves  the  motor's  position  and  velocity 
states  and  the  induced  back  emf  characteristics 
simultaneously.  A  simple  Newton  iterative  scheme  works  well 


on  the  outer  loop  because  of  filtering  and  smoothing 
provided  by  the  motor's  low  pass  response  characteristics. 

Despite  numerically  stiff  behavior,  the  highly 
nonlinear  and  discontinuous  nature  of  the  model  supports  the 
use  of  a  simple  small  step  trapezoidal  integrator.  Variable 
step  integration  involves  considerable  coding  structure  and 
computation  time  during  stiff  conditions,  neither  of  'which 
is  well  suited  for  the  limited  architecture  of  a  personal 
computer.  Direct  comparison  of  fixed  step  results  gained  in 
this  simulation  with  variable  step  results  described  by 
MacMillan  support  the  validity  of  fixed  step  integration. 
Convergence  criteria  establish  the  solution  accuracy  and 
efficiency  and  are  monitored  during  the  execution  of  the 
simulation  program.  Stiff  numerical  conditions  which  burden 
fixed  step  integration  are  identified  and  displayed  at  the 
console. 

The  successful  modeling  of  an  analog  system  in  a 
digital  simulation  relies  heavily  on  the  step  size. 
Particularly,  the  discontinuous  nature  of  this  model 
increases  the  likelihood  of  false  response  characteristics 
if  the  simulation  interval  is  not  carefully  selected. 
Oscillations  due  to  subharmonic  interaction  between  the 
simulation  increment  and  the  discontinuous  pulse  width 
modulated  forcing  function  may  result.  Position  control 
with  pulse  width  modulation  is  best  simulated  using  a  small, 
fixed  step  rather  than  a  variable  step  scheme  common  to 


stiff  integrators.  As  a  general  rule  of  thumb,  the 
simulation  step  increment  should  be  at  least  an  order  of 
magnitude  less  than  the  PWM  reference  period  to  eliminate 
aliasing  and  other  problems  associated  with  periodically 
sampled  systems. 

C.  POWER  CONDITIONER  SIMULATION 

Accurate  modeling  of  power  conditioning  and  commutation 
in  brushless  dc  motors  requires  explicit  definition  of  the 
physical  behavior  of  power  transistors  and  their  associated 
protective  diodes.  Lower  level  programming  is  required  to 
properly  imbed  the  conditions  necessary  to  naturally  trigger 
the  diodes  and  permit  realistic  simulation  of  their 
performance.  It  is  presumptuous  to  force  the  diodes  into 
the  conducting  state  during  the  entirety  of  their  thirty 
mechanical  degrees  of  protective  duty.  Simulation  of  the 
natural  behavior  of  e;  ctronic  components  is  of  particular 
importance  when  the  model  is  configured  for  position 
control.  Reversal  of  the  direction  of  rotation  may  be 
ordered  by  the  controller  at  any  time  or  position.  The 
randomness  of  the  forcing  function  as  observed  by  the  power 
conditioning  components  necessitates  that  behavior 
algorithms  be  generalized  to  ensure  simulation  robustness. 

Coil  inductance  action  in  brushless  dc  motors  is 
significant  and  deserves  particular  attention  in  this  study. 
When  current,  I,  flows  into  a  circuit  whose  inductance  is  L, 


the  electromagnetic  energy,  E,  will  be  stored  in  it  and  is 
given  by  Equation  2.1. 

E=iLI2  (2.1) 

The  corresponding  voltage  across  the  inductive  coil  is 
determined  by  the  change  in  current  flow  through  it  and  is 
described  by  Equation  2.2. 

V  =  L  di  (2.2) 

dt 

When  the  inductive  circuit  is  opened,  the  voltage 
induced  is  generally  sufficient  to  forward  bias  the 
appropriate  free-wheeling  diode  and  cause  it  to  conduct.  As 
long  as  a  low  resistance  return  path  for  the  exponentially 
decaying  current  flow  is  provided,  the  corresponding  voltage 
response  is  acceptable.  If  the  protective  diode  changes  to 
a  non-conducting  state  because  of  component  failure  or 
reverse  bias  conditions,  the  equivalent  resistance  of  the 
return  path  for  current  flow  becomes  very  high.  The 
resulting  faster  time  constant  of  the  circuit  promotes  rapid 
dissipation  of  any  electromagnetic  energy  stored  in  the 
inductive  coil.  If  significant  energy  remains  stored  in  the 
coil  at  the  time  of  diode  turn  off,  a  large  di/dt  and 
undesired  high  voltage  condition  will  result. 


Figures  2.4  through  2.9  describe  step  velocity  current 
and  voltage  response  characteristics  for  conditions  where 
the  protective  diodes  are  both  functional  and  inhibited. 
The  key  observations  made  from  these  six  plots  involve 
current  decay  rate  dependence  on  the  functional  status  of 
the  protective  diodes  and  the  corresponding  voltage 
conditions  observed  at  the  power  transistors.  Unacceptably 
high  voltage  transients  that  occur  across  the 
transistor/diode  pair,  as  shown  in  Figure  2.8,  result  when 
free-wheeling  diodes  malfunction.  Voltage  spikes  are 
limited  to  800  volts  in  the  computer  simulation  for  purposes 
of  graphic  scaling.  In  Figure  2.9,  functioning  diodes  are 
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behavior  results.  As  long  as  current  decay  is  numerically 
discontinuous,  the  induced  coil  potential  determined  by 
Equation  2.2  is  principally  dependent  on  the  simulation  step 
size.  Therefore,  the  magnitude  of  the  voltage  spike 
resulting  from  the  rapid  decay  of  12  amps  of  phase  current 
is  dominated  by  coil  potential  and  may  be  approximated 
analytically. 
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For  di  to  be  approximated  as  Al  at  a  value  of  12  amps, 
then  At  may  be  chosen  as  small  as  four  times  the  high 


«r 


•V-\  -r. 


resistance  decay  time  constant,  rdecay  Clearly,  30,000 
volts  of  potential  across  a  power  transistor  is  not 


realizable  and  junction  punch  through  would  most  likely 


relax  this  condition.  However,  resulting  transistor  damage 


is  highly  probable.  The  acceptable  peak  voltage  condftions 


depicted  in  Figure  2.9  are  affected,  but  not  dominated,  by 


induced  coil  potential.  As  shown  in  Figures  2.5  and  2.7, 


motor  and  phase  current  is  decayed  with  the  low  resistance 


time  constant,  allowing  reasonable  dissipation  of  stored 


electromagnetic  energy  from  the  coil. 


Digital  simulation  of  an  analog  component  or  circuit 


generally  may  be  accomplished  using  numerical  methods  and  a 


step  size  sufficiently  small  to  preserve  the  formation  of 


its  continuous  response  characteristics.  However,  the 


parallel  processing  behavior  of  the  inductive  coil  in  a 


highly  nonlinear  and  discontinuous  environment  is  not 


modeled  as  easily. 


A  protective  diode  is  triggered  when  its  biasing 


threshold  is  exceeded,  usually  the  result  of  commutation 


switching  action.  Each  finite  increment  of  the  digital 


simulation  is  uniquely  described  by  a  set  of  state 


conditions.  The  modeling  of  ideal  diode  characteristics 


introduces  discontinuous  behavior  in  the  circuit  and 


precludes  numerical  solution  using  simple  iterative  methods. 
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Figure  2.4  Motor  Current  Response  with  Diodes  Inhibited 
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Figure  2.5  Motor  Current  Response  with  Diodes  Functioning 


1HC  (amps)  .  IHC  (amps) 

-16.00  -8.00  0.00  8.00  18.00  **  -16.00  -8.00  0.00  8  00  18.00 


Consider  the  incremental  voltage  and  current  response  of  an 
affected  phase  leg  immediately  following  commutation 
switching.  The  voltage  response  of  the  inductive  coil  is 
determined  by  the  current  flow  to  which  the  coil  is 
subjected.  When  the  current  flow  is  apparently  cutoff,  a 
large  and  negative  induced  voltage  is  immediately  observed. 
This  voltage  condition  is  sufficient  to  forward  bias  the 
protective  diode  and  provide  a  low  resistance  return  path 
for  the  decaying  current.  However,  the  low  resistance  and 
positive  current  flow  result  in  a  voltage  which  reverse 
biases  the  diode.  This  apparent  toggling  of  the  diode 
presents  difficulty  in  the  numerical  convergence  and 
instantaneous  solution  for  each  affected  step  in  the 
simulation. 

If  the  step  size  could  be  reduced  to  an  inf initesmally 
small  period,  analog  simulation  would  be  realized  and  the 
diode  would  behave  realistically.  Continuous  modeling  is 
alternatively  achieved  through  programming  methods.  The 
polarity  of  the  coil  potential  is  fixed  and  not  allowed  to 
toggle  once  the  diode  has  been  forward  biased,  thereby 
eliminating  the  numerical  instability  caused  by  the 
discontinuous  behavior  of  the  diode.  Electromagnetic  energy 
is  allowed  to  dissipate  until  the  magnitude  of  the  coil 
potential  is  insufficient  to  sustain  a  forward  bias 
condition.  This  method  provides  robust  modeling  of 
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inductive  behavior  and  eliminates  the  undesired  effects  of 
digital  sampling. 

This  chapter  has  described  numerical  methods  employed 
to  facilitate  simulation  of  a  brushless  dc  motor  on  a 
personal  computer.  Model  development  has  focused  primarily 
on  electronic  commutation  and  power  conditioning.  The  task 
of  buffering  the  voltage  transient  behavior  associated^ with 
commutation  switching  is  investigated  in  Chapter  III. 


III.  TRANSIENT  RESPONSE  WAVESHAPING 

A.  BACKGROUND 

Relatively  minor  adaptations  to  the  power  conditioning 
model  developed  by  MacMillan  and  illustrated  in  Figure  2.2 
result  in  dramatic  variation  of  the  electronic  environment 
to  which  the  solid  state  components  are  subjected.  In 
general,  modifications  which  limit  hazardous  voltage 
conditions  at  the  power  transistors  during  commutation 
switching  restrict  the  motor's  overall  torque  capability. 

Stiff  current  characteristics  indicate  exaggeration  of 
the  transient  voltage  response  acting  on  solid  state 
devices.  Refinement  and  reshaping  of  the  phase  current 
waveforms  may  be  undertaken  with  the  prospect  of  minimizing 
adverse  voltage  effects. 

Modifications  to  power  conditioning  circuitry  is 
investigated  in  this  chapter  using  step  velocity  response 
characteristics  of  the  brushless  dc  motor.  Unidirectional 
kinematics  associated  with  open  loop  behavior  facilitate 
response  waveshaping  without  the  complication  of  rotational 
reversal . 

B.  COMMUTATION  ADVANCE  &  RETARD 

The  switching  logic  detailed  by  Thomas  in  [Ref.l]  for 
motor  rotation  in  clockwise  and  counterclockwise  directions 


is  summarized  in  Table  I.  This  logic  assumes  maximum 
torquing  conditions;  that  is,  the  rotor  is  located  in  such  a 
position  that  its  field  flux  is  orthogonal  to  the  stator's 
electromagnetic  field.  Hall-effect  sensors  are  used  to 
provide  quantized  rotor  position  information  to  the  power 
conditioner  for  generation  of  sequencing  logic. 

TABLE  I 

SENSOR  AND  SWITCHING  LOGIC 

Rotor  RPS  Clockwise  Counterclockwise 
Position  A  g  C  £1  Q2  22  21  Q5  £6  01  02  03  Q4  05  06 

0-30°  101  000110  001001 
30-60°  100  100100  011000 
60-90°  110  100001  010010 
90-120°  010  001001  000110 
120-150°  011  011000  100100 
150-180°  001  010010  100001 

Deviation  from  this  orthogonal  relationship  may  be 
accomplished  by  either  advancing  or  retarding  commutation. 
Displacement  in  relative  angular  position  between  the 
electromagnetic  field  and  the  field  flux  is  attainable 
through  modification  of  the  commutation  sequencing  logic. 

Figures  3.1  through  3.6  describe  the  motor's  electrical 
response  characteristics  when  commutation  is  advanced  and 
retarded.  Operational  reliability  of  the  motor,  which  is 
largely  influenced  by  the  voltage  conditions  experienced  by 
power  conditioning  electronic  components,  must  be  considered 
when  maximizing  its  mechanical  performance.  Numerous 
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Figure  3-1  Motor  Current  Response  (Commutation  Retarded  5°) 
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Figure  3.2  Center  Point  Trajectory  (Commutation  Retarded  5”) 
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Figure  3.5  Motor  Current  Response  (Commutation  Advanced  5°) 
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Figure  3.6  Center  Point  Trajectory  (Commutation  Advanced  5°) 
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simulations  with  varying  degrees  of  commutation  advance  and 
retard  indicate  maximum  system  responsiveness  at  orthogonal 
field  conditions. 

The  free  floating  center  connection  of  the  wye 
configured  model  (Node  0  in  Figure  2.2)  serves  as  a  common 
voltage  node  for  the  three  phase  network.  This  node  is 
offset  from  its  nominal  value  of  0  volts  when  ~ load 
distribution  of  the  network  is  unbalanced.  The  trajectory 
of  the  center  connection  is  determined  by  Kirchoff's  voltage 
law  and  is  a  function  of  the  generated  back  emf,  phase 
current  through  the  field  windings,  and  the  inductive  coil 
potential.  Back  emf  is  predictable  under  most  load 
conditions  and  may  be  uncoupled  from  the  effects  of  the 
coil.  The  trajectory  provides  a  comprehensive  indication  of 
voltage  transient  behavior  in  the  motor  during  commutation. 
Minimization  of  the  trajectory's  peak  voltage  values  will 
reduce  high  voltage  conditions  experienced  by  the  power 
transistors . 

It  is  of  particular  interest  to  compare  the  step 
velocity  center  point  trajectory  shown  in  Figure  3.4  with 
the  response  determined  by  MacMillan  and  given  in  [Ref. 2, 
Fig. 5. 8].  A  fundamental  premise  of  MacMillan's  model  is 
that  the  three  phase  network  behaves  in  a  symmetric  fashion. 
This  assumption  permits  the  center  point  trajectory  to  be 


trajectory  to  be  described  solely  in  terns  of  magnetic  flux 
and  ignores  the  cummulative  effects  of  the  inductive  coil. 

Fin  step  velocity  transient  response  characteristics 
provide  an  appropriate  means  of  quantizing  the  general 
responsiveness  of  the  motor.  Even  during  the  most  demanding 
periods  of  flight  control,  fin  actuation  dynamics  are 
contained  within  the  initial  transient  response  of  the  open 
loop  configured  velocity  device.  A  mechanical  performance 
factor  describing  fin  positioning  responsiveness  may  be 
determined  by  computing  the  normalized  average  slope  of  the 
fin  velocity  step  response  measured  between  0  and  60%  of 
steady  state  velocity.  Figure  3.7  illustrates  the 
quantization  of  mechanical  performance  of  a  brushless  dc 
motor  with  no  commutation  offset. 


Figure  3.7  Mechanical  Performance  Factor  Description 


Electrical  performance  is  well  described  by  the  motor's 
center  point  voltage  response.  The  transient  effects  of 
commutation  switching  and  back  emf  generation  characterize 
the  trajectory.  Excessively  high  voltage  conditions 
observed  at  the  center  connection  correspond  to  unacceptable 
behavior  at  the  power  transistors.  Therefore,  electrical 
performance  is  quantized  by  normalizing  average  peak  values 
of  the  center  point  trajectory. 

Figure  3.8  illustrates  the  relationship  between 
commutation  offset  and  electrical-mechanical  performance  of 
the  brushless  dc  motor  for  ±30°  of  commutation  offset  angle. 
Commutation  at  orthogonal  field  conditions  provides  maximum 
system  responsiveness,  which  degrades  in  a  somewhat 
symmetrical  manner  as  advance  and  retard  angles  are 
increased. 

Center  point  trajectory  peak  voltage  values  in  excess 
of  500  volts  are  illustrated  in  Figure  3.6.  Therefore,  the 
unacceptable  electrical  response  behavior  associated  with 
advanced  commutation  invalidates  its  application  in  this 
design.  Additionally,  significant  retarding  of  commutation 
is  required  to  noticeably  reduce  the  high  voltage  conditions 
associated  with  commutation  switching.  Because  of  the 
substantial  compromise  in  performance  at  these  retarding 
offsets,  neither  commutation  advancing  nor  retarding  was 
deemed  advantageous  and,  therefore,  not  implemented. 


C.  DIODE  BIAS  THRESHOLD 


The  demanding  operating  conditions  encountered  by  the 
brushless  dc  motor  in  service  necessitate  current  limiting 
protection.  Previous  models  have  provided  this  protection 
with  a  relatively  large  power  supply  series  resistance. 
Fluctuations  in  load  and  general  performance  of  the  motor 
are  comfortably  absorbed  using  such  a  method  of  current 
limitation.  However,  the  scheme  reduces  motor  supply  line 
voltage  to  an  unacceptably  low  level  with  respect  to  biasing 
threshold  requirements  of  the  protective  diodes.  Even 
though  protective  diodes  are  functioning  properly  during 
commutation  switching,  stiff  current  conditions  are  observed 
near  the  peaks  of  current  ripple  in  the  response  shown  in 
Figure  3.3.  During  cyclic  conditions  of  maximum  emf 
generation,  protective  diodes  are  falsely  forward  biased  due 
to  insufficient  line  voltage.  Random  diode  triggering  may 
short  active  circuits  and  result  in  abrupt  behavior  in 
current  and  voltage  responses. 

Modification  of  the  3-phase  model  shown  in  Figure  2.2 
allows  for  the  same  value  of  equivalent  supply  resistance  to 
be  divided  in  series  across  each  transistor-diode  pair  and 
is  illustrated  in  Figure  3.9.  The  reconfiguration  permits 
selection  of  the  voltage  divider  relationship  necessary  for 
correct  triggering  of  the  protective  diodes  during 
commutation  switching  and  maintains  a  viable  means  of 
current  limiting  protection  through  series  resistance. 
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Voltage  divider  percentage  is  determined  by  Equation 


Voltage  Divider  %  -  R^n  /  (R^n  +  Rout^  (3*1) 

Figures  3.10  through  3.15  illustrate  the  effects  on 
current  and  voltage  response  when  the  free-wheeling  diode's 
bias  threshold  is  varied  by  voltage  divider  adjustment.  As 
observed  in  Figure  3.3,  insufficient  bias  threshold  results 
in  unexpected  diode  firing  and  short  circuiting  of  the 
affected  phase.  On  the  other  hand,  excessive  bias  threshold 
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conditions,  such  as  the  63%  voltage  divider  configuration 
illustrated  in  Figures  3.10,  3.12,  and  3.14,  result  in 
premature  cutoff  of  the  protective  diodes  during  free¬ 
wheeling  conditions.  The  electromagnetic  energy  stored  in 
the  coil  is  not  sufficiently  dissipated  through  a  low 
resistance  path  and  high  voltage  conditions  are  observed 
across  the  power  transistors  in  Figure  3.14.  tt  is 
interesting  to  note  that  excessive  bias  threshold  conditions 
preclude  forward  biasing  of  protective  diodes  during  only  a 
single  switching  operation  as  illustrated  in  Figure  3.10  at 
t=2. 5msec.  This  is  explained  by  the  velocity  dependence  of 
back  emf.  At  lower  speeds,  the  inductive  coil  is 
insufficiently  supplemented  by  back  emf  generation  to 
forward  bias  the  protective  diode.  At  higher  speeds, 
however,  back  emf  generation  is  significant  and  adequately 
contributes  towards  satisfying  diode  triggering  criteria.  A 
50%  voltage  divider  ensures  robust  diode  operation  and 
provides  effective  current  limiting.  The  corresponding 
electrical  transient  characteristics  of  this  configuration 
are  depicted  in  Figures  3.11,  3.13,  and  3.15.  Figure  3.15 
clearly  indicates  reduction  of  the  peak  voltage  accross  the 


transistor. 
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D.  CURRENT  DECAY  TIME  CONSTANT 


The  exponential  decay  of  current  in  a  relaxing  phase  is 
described  uniquely  by  a  dynamic  time  constant.  The 
circuit's  time  constant  is  determined  by  the  phase 
inductance,  L,  divided  by  its  equivalent  path  resistance. 
Previous  modeling  provides  either  high  or  low  path 
resistance  conditions  determined  by  the  state  of-  the 
protective  diode.  A  high  resistance  state  yields  extremely 
fast  time  constants  which  results  in  high  di/dt  values. 
Conversely,  the  low  resistance  state  is  described  by  a 
relatively  slow  decay  transient.  If  the  transient's 
duration  exceeds  the  time  required  for  30°  of  mechanical 
rotation,  then  the  remaining  electromagnetic  energy  stored 
in  the  coil  will  be  exponentially  dissipated  with  the  fast 
time  constant.  This  condition  is  characterized  by  undesired 
high  voltage  transients  across  the  power  transistors  and  is 
found  to  be  more  prevalent  at  higher  operating  speeds  where 
less  time  for  energy  dissipation  is  available. 

The  simulation  program  is  provided  with  an  adjustable 
resistance  placed  in  series  with  each  protective  diode  to 
permit  control  of  the  phase  current's  decay  time  during 
free-wheeling.  Location  of  the  adjustable  resistance 
( RDADJ )  in  the  power  conditioning  model  is  given  in  Figure 
3.9.  Average  response  characteristics  of  the  motor  are 
unaffected  by  this  added  resistance  since  it  is  negligible 
when  compared  to  the  equivalent  loop  resistance.  However, 
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RDADJ  dominates  the  current  decay  return  path  resistance  and 


essentially  determines  the  circuit's  time  constant. 
Physical  implementation  is  feasible  since  the  added  resistor 
is  external  to  the  motor  and  actually  a  component  of  the 
power  conditioner. 

Figures  3.16  through  3.21  graphically  depict  the 
waveshaping  effects  of  RDADJ  on  phase  current  and  transistor 
voltage.  Selection  of  the  rate  adjusting  resistance  is  a 
fairly  straightforward  task  since  it  is  clearly  bounded  by 
its  consequences.  Increased  decay  rate  results  from 
increasing  the  resistance  (RDADJ)  and  corresponds  directly 
to  higher  voltage  transients  at  the  power  transistors. 
Figures  3.18  and  3.19  illustrate  the  intolerable 
consequences  associated  with  the  selection  of  a  very  fast 
time  constant.  A  3D  resistance  for  RDADJ  improves  the  decay 
time  constant  significantly  with  an  increased  but  acceptable 
transistor  voltage  transient  peak,  which  is  shown  in  Figure 
3.21. 
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Figure  3.19  Transistor  #5  Voltage  Response  (RDADJ 


Step  velocity  response  waveshaping  has  been  exploited 
to  optimize  the  transient  characteristics  of  the  brushless 
dc  motor  and  its  associated  electronic  commutation 
circuitry.  Many  of  the  benefits  of  such  refinement  are  not 
readily  apparent  during  unidirectional  rotation.  However, 
the  highly  accentuated  transient  behavior  associated  with 
closed  loop  position  control  is  significantly  affected  by 
these  modifications  and  will  receive  further  attention  in 
the  Chapter  IV. 


IV.  CLOSED  LOOP  CONSIDERATIONS 


A .  BACKGROUND 

NPS  studies  of  brushless  dc  motors  primarily  support 
variable  speed  control  applications  [Refs.  1,2, 6, 7].  Very 
limited  documentation  concerning  its  viability  in  closed 
loop  position  control  appears  in  the  referenced  literature. 
Previous  research  at  NPS  has  also  been  restricted  mainly  to 
open  loop  (velocity)  performance  characteristics.  However, 
brushless  dc  motor  cruise  missile  fin  control  was 
investigated  and  simulated  by  Franklin  using  an  equivalent 
lumped  parameter  model  [Ref. 7].  Additionally,  MacMillan's 
detailed  model  provides  rudimentary  observation  of  motor 
current  transient  behavior  when  rotational  direction  is 
reversed. 

In  addition  to  the  unidirectional  kinematics  normally 
associated  with  variable  speed  control,  closed  loop 
position  control  includes  such  conditions  whereby 
mechanical  rotation  and  electrically  developed  torque 
oppose  each  other.  The  intention  of  this  chapter  is  to 


study  closed  loop  positioning  characteristics  of  brushless 
dc  motors,  with  particular  emphasis  on  the  transient 
behavior  associated  with  reversing  rotational  direction. 


B.  CLOSED  LOOP  MECHANICS 

The  mechanics  of  position  control  of  a  permanent  magnet 
dc  motor  are  broadly  described  by  three  electromechanical 
conditions.  The  natural  operational  state  of  a  working  dc 
motor  is  known  as  motoring.  This  condition  is  characterized 
by  electrical  to  mechanical  energy  conversion  and  occurs 
when  the  motor  is  driven  between  zero  and  steady  'state 
speeds.  When  the  motor  is  forced  to  rotate  at  a  greater 
rate  than  its  steady  state  speed  either  by  external 
disturbance  or  decreased  supply  voltage,  generator  action 
is  realized.  Generation  converts  mechanical  to  electrical 
energy  and,  if  suitably  configured,  can  be  used  to 
replenish  the  power  supply  through  regeneration.  The 
mechanical  energy  consumed  in  electrical  regeneration 
dynamically  brakes  motor  rotation  and  provides  increased 
deceleration  during  relaxation  conditions.  The  third 
operational  state  is  forced  braking  and  occurs  when  the  motor 
is  forced  to  rotate  against  its  present  direction. 
Associated  with  the  resulting  intense  rotational 
deceleration  are  electrical  transients  that  are  accentuated 
and  often  result  in  destructive  magnitude  of  current 
through  and  voltage  across  the  power  transistor/diode  pair. 


C.  FOUR  QUADRANT  OPERATION 

The  electronic  commutation  of  a  three  phase,  4-pole 
brushless  dc  motor  configured  for  position  control  may  be 
more  comprehensively  described  as  four  quadrant  operation 
[Ref. 9].  Following  in  similar  manner,  Figure  4.1 
illustrates  the  electromechanical  conditions  describing  the 
four  quadrants.  Electromagnetic  field  orientation 
determines  the  electrically  developed  torque,  T,  which 
forces  rotation  in  a  prescribed  direction.  This  torquing 
direction  is  denoted  by  the  variable  "DIR"  in  the  computer 
simulation  and  is  accomplished  through  logic  sequencing  of 
the  power  transistors.  Actual  mechanical  rotation,  w, 
describes  the  kinematic  state  of  the  rotor. 

The  transient  dynamics  involved  in  attaining  positional 
steady  state  may  be  classified  as  forward  motoring,  forward 
braking,  reverse  motoring,  and  reverse  braking.  Except  for 
directional  differences,  response  characteristics  of 
forward  and  reverse  motoring  are  symmetric,  as  are  those  of 
forward  and  reverse  braking.  As  shown  in  Figure  4.1, 
reversal  of  commutation  direction  may  be  buffered  by 
generator  action  if  any  degree  of  system  relaxation  is 
provided  by  the  controller. 

Quadrants  II  and  IV  of  Figure  4.1  describe  motoring 


conditions , 

where  actual 

mechanical 

rotation 
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characteristics  are  electrically  similar  to  unidirectional, 
open  loop  behavior.  Transient  conditions  are  relatively 
well  behaved  since  protective  diodes  are  able  to  dissipate 
electromagnetic  energy  stored  in  relaxed  phase  inductive 
coils  as  intended.  The  back  emf  generated  while  motoring 
converts  the  mechanical  energy  of  rotation  to  electrical 
energy  proportional  to  the  speed  of  rotation  arid  is 
opposite  in  polarity  of  the  forcing  potential.  The 
superposition  of  source  and  generated  voltage  net  a  reduced 
electromotive  force  and,  therefore,  impede  and  eventually 
limit  the  motor's  rotational  rate. 

Forced  braking  immediately  follows  the  reversal  of 
electronic  commutation  and  is  illustrated  in  quadrants  I 
and  III  of  Figure  4.1.  This  condition  is  commonly  referred 
to  as  plugging  in  a  brush-type  motor  and  occurs  when  the 
applied  voltage  is  reversed  in  polarity.  Plugging  of 
brushless  dc  motors  is  accomplished  through  commutation 
logic  sequencing,  since  supply  voltage  polarity  is  fixed. 
Consider  the  lightly  damped  fin  angle  stepped  response  also 
shown  in  the  figure.  When  the  forward  running  motor  comes 
to  zero  speed  under  braking  action  at  t=tj_,  it 
automatically  gets  accelerated  in  the  reversed  direction 
since  the  commutation  logic  for  forward  braking  and  reverse 
motoring  is  identical.  While  rapid  braking  and  reversing 
characteristics  are  desired  in  a  position  control  system, 
the  exaggerated  transient  behavior  of  the  motor  is 


electronically  demanding  and  may  result  in  damage  to  solid 
state  devices. 

Figure  4.1  also  indicates  the  presence  of  generator 
action  immediately  adjacent  to  commutation  reversal.  If 
the  controller  provides  suitable  conditions  for  natural 
response  of  the  motor,  energy  is  converted  by  regenerative 
processes  and  dynamic  braking  is  attained.  Controllers 
which  operate  with  a  dead  zone  or  have  soft  response 
characteristics  often  promote  generator  action  and  are 
associated  with  better  behaved  transients.  Conversely, 
stiff  controllers  with  no  dead  zone,  such  as  an  ideal 
relay,  do  not  experience  natural  response  conditions  when 
plugged.  Therefore,  the  buffering  effect  provided  by 
dynamic  braking  is  not  exploited  by  high  performance 
controllers  and  the  corresponding  electrical  response  is 
characterized  by  excessive  transient  behavior. 
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Figure  4.1  Four  Quadrant  Operation  of  a  Brushless  DC  Motor 
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D.  TRANSIENT  BEHAVIOR 

The  excessive  transient  behavior  observed  during 
braking  is  explained  by  several  factors.  Generated  back 
emf  is  now  of  the  same  polarity  as  the  forcing  potential 
and  the  superposition  of  source  and  generated  voltages  net 
an  enhanced  electromotive  force.  The  resulting 
responsiveness  of  the  system,  as  well  as  its  transient 
behavior,  is  increased. 

Electromagnetic  energy  stored  in  an  apparently  cutoff 
phase  inductive  coil  for  the  three  phase,  4-pole  motor  is 
intended  to  be  dissipated  within  the  time  required  for 
thirty  degrees  of  mechanical  rotation.  When  the  motor  is 
initially  plugged,  less  time  is  likely  to  be  available  for 
decay  and  high  voltage  conditions  may  result. 

During  forced  braking  conditions,  the  direction  of 
actual  mechanical  rotation  (u>)  opposes  the  prescribed 
commutation  logic  sequence  and  results  in  commutation 
switching  performed  in  reverse  order.  This  apparent  back- 
stepping  through  the  sequencing  logic  results  in  reversal, 
rather  than  redirection,  of  phase  current  flow  within  the 
motor.  The  effects  of  rapidly  reversing  current  flow 
within  the  motor  is  significant  due  to  the  nature  of  the 
inductive  coil  and  result  in  intolerable  voltage 
transients . 

The  commutation  logic  which  sequences  the  switching  of 
power  transistors  should  be  sensitive  to  the  controller's 


mode  of  operation.  While  in  the  forced  braking  mode, 
complete  transistor  switching  cannot  be  performed 
simultaneously  without  catastrophic  results,  and  a  two  step 
sequence  is  called  for.  Stored  coil  energy  in  the  affected 
phase  should  be  minimized  prior  to  reversing  the  direction 
of  the  current  flow  through  it.  Therefore,  a  time  delay  is 
required  between  switching  off  the  existing  current  and 
switching  on  the  reversing  current.  During  this  momentary 
period  of  natural  response,  phase  current  should  be  decayed 
with  a  reasonable  time  constant  to  reduce  the  voltage 
transients  associated  with  current  reversal.  If  the 
commutation  delay  exceeds  the  current  decay  time,  near 
complete  dissipation  of  the  energy  stored  in  the  coil  will 
be  realized  and  the  reversal  of  current  can  be  performed 
acceptably. 

The  rate  of  decay  of  electromagnetic  energy  stored  in  a 
relaxed  coil  is  determined  by  the  circuits  time  constant. 
The  addition  of  a  3n  resistance  in  the  decay  path,  as 
discussed  in  Chapter  III,  provides  more  rapid  dissipation 
of  the  stored  energy-  Less  delay  time  is  required  for 
faster  decaying  current  conditions,  thereby  minimizing 
system  performance  degradation  during  commutation 
switching.  Figure  4.2  depicts  a  typical  first  reversal 


encountered  during  fin  position  response  when  a  10°  step  of 
demand  is  applied  using  an  ideal  relay  type  controller. 


Figure  4.2  Fin  Reversal  During  Position  10*  Step  Response 


The  effect  on  current  and  voltage  waveform  of 
commutation  switching  delay  in  fin  position  control  during 
this  reversal  is  illustrated  in  Figures  4.3  through  4.6. 
Transient  current  behavior  and  center  connection  voltage 
response  (Node  0)  with  no  commutation  delay  applied  are 
shown  in  Figures  4.3  and  4.5.  Current  is  observed  to  be 
decayed  very  rapidly  in  Figure  4.3  when  plugged  due  to  the 
nearly  instantaneous  reversal  of  phase  current.  The  rapid 
change  in  current  flow  induces  very  large  coil  potential, 
exhibited  in  Figure  4.5  as  a  voltage  spike  in  excess  of 
1000  volts. 
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Figures  4.4  and  4.6  depict  much  more  acceptable 
response  behavior  when  a  500/isec  delay  is  provided.  The 
exponential  decay  of  motor  current  shown  in  Figure  4.4  is 
much  slower,  however,  and  does  not  completely  dissipate  the 
coil  energy.  A  voltage  spike  of  160  volts  is  observed  in 
Figure  4.6  and  corresponds  to  the  rapid  dissipation  of 
remaining  coil  energy.  Complete  dissipation  of  the  stored 
coil  energy  is  apparently  not  practical,  particularly  at 
high  rotational  rates,  due  to  relatively  long  decay  time 
requirements.  However,  voltage  transients  during  braking 
are  minimized  by  nearly  an  order  of  magnitude  using  a  delay 
time  of  500/isec. 

In  general,  highly  responsive  position  control  of  a 
brushless  dc  motor  is  attained  at  the  expense  of  its 
electrical  transient  behavior.  Specifically,  the  level  of 
energy  stored  in  an  inductive  coil  immediately  prior  to 
braking  determines  the  extent  of  its  transient.  Extremely 
stiff  controllers,  such  as  an  ideal  relay,  provide  maximum 
electromotive  force  to  the  motor  at  all  times  during 
positioning.  Figures  4.7  and  4.9  illustrate  the 

unacceptable  transient  current  and  voltage  behavior 
associated  with  the  unbuffered  bang-bang  response.  Figure 
4.7  indicates  a  rapid  transient  behavior  of  plugged  phase 
current  which  results  in  the  1000  volt  spike  shown  in 
Figure  4.9.  The  inclusion  of  a  ±2°  dead  zone  invokes 
generator  action  whose  effects  are  described  in  Figures  4.8 
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and  4.10.  The  relatively  large  window  provided  for  system 
relaxation  by  ±2°  dead  zone  is  clearly  depicted  in  Figure 
4.8,  with  current  characterized  by  the  dominant  effects  of 
back  emf  and  dissipating  coil  energy.  Figure  4.10  indicates 
a  corresponding  voltage  spike  of  only  150  volts  was 
induced.  A  finite  amount  of  stored  coil  energy  was 
converted  to  mechanical  energy  during  motor  relaxation 
provided  by  controller  dead  zone.  However,  system  accuracy 
is  sacrificed  when  dead  zone  is  applied  and  the  duration  of 
natural  system  response  required  to  significantly  reduce 
the  high  voltage  transients  is  unacceptably  large. 
Additionally,  a  fixed  dead  zone  which  is  effective  at  lower 
speeds,  may  not  provide  sufficient  system  relaxation  at 
greater  rotational  rates  where  less  time  is  required  to 
transit  the  dead  zone.  Figure  4.10  shows  an  increased 
voltage  spike  magnitude  of  300  volts  associated  with  a 
higher  speed  reversal.  While  dead  zone  can  be  used  to 
reduce  voltage  transients,  it  is  not  solely  sufficient  to 
ensure  acceptable  behavior. 
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It  has  been  shown  in  this  chapter  that  high  performance 
position  control  of  brushless  dc  motors  is  generally 
attained  at  the  expense  of  its  power  conditioning 
electronic  component  reliability.  In  support  of  the  need 
for  responsive  fin  actuation,  reasonable  steady  state 
accuracy  and  buffered  electrical  transient  behavior,  pulse 
width-  modulation  is  examined  in  Chapter  V. 


V.  PULSE  WIDTH  MODULATION 

A .  BACKGROUND 

Two  distinct  categories  of  error  signal  amplifiers, 
linear  and  nonlinear,  are  available  for  this  application. 
The  difference  between  the  two  lies  primarily  in  the  manner 
in  which  they  drive  the  solid  state  devices  of  the  power 
conditioner.  Linear  servo-amplifiers  drive  bipolar 
transistors  in  their  active  regions  and  permit  continuous 
voltage  regulation,  while  nonlinear  servo-amplifiers 
maintain  transistor  operation  in  either  saturation  or 
cutoff.  Pulse  width  modulation  (PWM)  is  one  method  of 
providing  nonlinear  servo-amplifier  control  of  a  brushless 
dc  motor  and  is  the  focus  of  discussion  in  this  chapter. 

While  linear  servo-amplifier  circuits  are  relatively 
simple  and  essentially  free  of  electrical  noise,  they  are 
subject  to  thermal  damage  [Ref. 8].  The  fact  that  these 
amplifiers  drive  bipolar  transistors  in  their  linear  region 
explains  the  substantial  amount  of  power  dissipation  into 
heat  that  takes  place  in  the  commutation  switching 
electronics.  Space  constraints  in  the  cruise  missile  fin 
actuator  application  preclude  the  use  of  large  heat  sinking 
elements  necessary  to  protect  solid  state  components  from 
thermal  damage.  Conversely,  pulse  width  modulated 
amplification  is  characterized  by  negligible  power 


dissipation  into  heat.  Although  two  state  transistor 
operation  is  thermally  advantageous,  it  is  a  source  of 
increased  electrical  noise  due  to  switching.  Fortunately, 
PWM  is  negligibly  influenced  by  noise  since  the  random 
variation  of  amplitude  has  little  effect  on  the  information 
contained  in  the  pulse  width  modulated  signal. 
Additionally,  the  extent  of  current  ripple  and  subharmonic 
oscillation  due  to  the  periodic  output  of  the  pulse  width 
modulator  is  insignificant  [Ref. 6].  Since  the  power 
transistors  are  switched  on  and  off  at  a  frequency  far 
exceeding  the  motor's  bandwidth,  the  majority  of  the  high 
frequency  component  of  the  modulated  signal  is  filtered  by 
the  motor. 

Pulse  width  modulation  is  a  technique  for  regulating 
the  amount  of  energy  supplied  to  the  motor  for  development 
of  torque.  Effective  regulation  is  accomplished  by 
modulating  a  fixed  voltage  amplitude  on  a  reference 
frequency  and  linearly  scaling  its  pulse  duty  cycle. 

B.  DESCRIPTION 

The  PWM  scheme  modeled  in  this  study  behaves  similarly 
to  the  Dither  Method  outlined  by  Askinas  [Ref. 6]  and  is 
illustrated  in  Figure  5.1.  A  reference  sawtooth  waveform 
of  desired  frequency  and  amplitude  is  generated  through 
independent  circuitry  and  is  differenced  with  the  closed 
loop  system's  amplified  position  error  signal. 


PULSE  WIDTH  MODULATION 

FUNCTIONAL  MODEL 
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Figure  5.1  Pulse  Width  Modulation  Functional  Model 

The  amplifier  is  comprised  of  linear  and  nonlinear 
regions  of  operation.  Nonlinear  gain,  denoted  as  "Kp^"  in 
the  computer  simulations  appended,  is  applied  as  saturation 
amplification  to  the  error  signal.  Relay  elements  are  used 
to  convert  the  bias  of  the  summed  signal  to  a  tri-state 
logic  output  which  is  summarized  in  Figure  5.1.  Because 
the  polarity  of  the  source  voltage  is  fixed,  directional 
rotation  is  accomplished  using  separate  commutation 
sequences  as  shown  in  Table  I.  "DIR"  is  the  variable  used 
to  indicate  commutation  direction  in  the  simulation  and  is 
assigned  a  value  of  +1  for  clockwise  rotation  and  -1  for 
counterclockwise  rotation.  With  "DIR"  accounting  for 


3 


directional  convention,  forcing  potential  (VIN)  is 
controlled  by  two-state  logic.  When  PWM  logic  triggers  the 
application  of  150V  supply  voltage  to  the  motor  and 
determines  the  commutation  sequencing  logic  requested  by 
the  controller,  powering  conditions  remain  fixed  for  the 
remainder  of  the  reference  period. 

Figure  5.2  illustrates  the  convenient  one-to-one 
relationship  between  the  nonlinearly  amplified  error  signal 
( ( E [ )  and  the  duty  cycle  of  the  pulsed  output  (PULSE).  Due 
to  the  saturation  amplification  of  the  system  error 
(POSERR)  ,  |E|  is  bounded  within  the  range  from  zero  to 
unity. 


Figure  5.2  Relationship  Between  |e|  and  Pulse  Duty  Cycle 
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THRESH  describes  the  biased  error,  and  is  given  by 


Equation  5.1.  When  THRESH  is  less  than  the  reference 
sawtooth  signal  during  each  cycle,  VIN  is  pulsed  on  by  the 
PULSE  signal. 


THRESH  =  1  -  I E I 


(5.1) 


The  linear  nature  of  the  reference  sawtooth  signal  over 
each  pulsing  period  results  in  linear  scaling  of  pulse  duty 
cycles  when  the  error  is  in  the  range  {  0  <  |e|  <  1  ).  The 
relationship  observed  in  Figures  5.1  and  5.2  between  E  and 
the  duty  cycle  of  VIN  is  given  by  Equation  5.2. 


Duty  Cycle  of  VIN  =  |E|*T 


(5.2) 


Figures  5.3  through  5.8  are  examples  of  open  loop 
transfer  characteristics  of  the  pulse  width  modulator 
modeled  in  this  study.  Pulse  width  modulation  of  ramp  and 
sinusoidal  (undamped  and  exponentially  decaying)  error 
signals  are  examined  with  varying  amplifier  gain  and  dead 
zone  to  illustrate  its  properties.  Open  loop  PWM  transfer 
characteristics  are  ascertained  using  the  simulation  listed 
in  Appendix  B.  Figure  5.3  depicts  the  linear  scaling  range 
of  the  PWM  amplifier  for  a  specific  gain.  In  this  case, 
KpwM  (gain)  equals  0.5  and,  when  applied  to  the  continuous 
input  ramp  error  signal,  results  in  an  increased  range  of 


modulation  for  the  directional  logic  signal.  Figure  5.4 
illustrates  the  effect  of  increased  amplifier  gain  as  well 
as  the  inclusion  of  a  controller  dead  zone.  For  an 
identical  ramp  error  signal  input,  the  increased  gain 
results  in  a  reduced  linear  region  of  modulation.  Dead 
zone  is  observed  in  Figure  5.4  near  the  zero-crossing  of 
the  input  error  signal  (t=2. 5msec)  and  is  characterized  by 
a  corresponding  Directional  Logic  level  of  0.  Therefore, 
the  use  of  dead  zone  in  the  PWM  amplifier  buffers  the 
effects  of  switching  when  the  error  signal  changes 
polarity.  Figure  5.5  illustrates  the  pulse  width 

modulation  of  an  undamped  sinusoidal  error  signal  with  low 
amplifier  gain  and  no  dead  zone.  The  sinusoidal  waveform 
is  reasonably  well  preserved,  but  would  be  much  improved 
with  a  higher  sampling  frequency.  Modulation  of  the  same 
sinusoid  at  a  higher  gain  and  with  dead  zone  is  shown  in 
Figure  5.6.  Very  little  width  modulation  takes  place  when 
gain  is  high  due  to  saturation  effects  and  causes  VIN  to 
resemble  the  output  characteristics  of  a  relay  with  dead 
zone.  The  pulse  width  modulation  of  relatively  large  scale 
sinusoidal  error  inputs  is  examined  in  Figures  5.5  and  5.6. 
In  position  control  application,  however,  error  amplitudes 
associated  with  stable  systems  tend  to  decrease  with  time. 
Additionally,  larger  amplifier  gains  for  this  Type  1  system 
provide  improved  steady  state  accuracy  and  is  further 
discussed  in  Chapter  VI.  The  exponentially  decaying 


sinusoid  used  as  an  input  error  signal  in  Figures  5.7  and 
5.8  presents  a  more  realistic  representation  of  the  range 
of  inputs  to  be  encountered.  The  low  gain  configuration 
illustrated  in  Figure  5.7  results  in  linear  modulation  of 
the  waveform  over  the  range  examined  and  is  characterized 
by  the  Directional  Logic  signal  pulse  width  being 
proportional  to  the  input  error  signal  amplitude.  ~  The 
pulse  width  characteristically  decreases  with  the 
exponentrially  decaying  magnitude  of  the  input. 
Conversely,  the  modulation  using  high  gain  with  the  same 
input  is  shown  in  Figure  5.8  and  results  in  saturation  of 
the  output  pulse  as  shown  by  fixed  pulse  width  during 
periods  of  relatively  large  input  magnitude. 

C.  PARAMETER  SELECTION 

Time  averaging  provided  by  low  pass  characteristics  of 
the  brushless  dc  motor  smooth  the  effects  of  the 
discontinuous  pulse  width  modulated  forcing  function.  The 
PWM  may  be  analytically  treated  as  a  piecewise  continuous 
function  if  specific  approximation  criteria  are  satisfied. 
Validity  of  such  an  approximation  is  principally  determined 
by  the  reference  sawtooth  frequency  of  the  PWM.  Lumped 
parameter  analysis  of  this  typical  motor  used  in  this  study 
reveals  an  average  mechanical  time  constant,  r^, 
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seconds  and  an  electrical  time  constant,  r£,  of  .000165 
seconds.  Despite  the  dominant  low  pass  characteristics  of 
the  slow  mechanical  time  constant,  empirical  derivation 
based  on  computed  results  indicates  the  pulse  width 
modulation  reference  sawtooth  frequency  should  be  at  least 
lOKHz.  At  such  frequencies,  the  motor  effectively  smoothes 
the  pulsed  forcing  action  of  the  PWM.  Phase  plane  methods 
discussed  in  Chapter  VI  are  used  to  graphically  illustrate 
the  effects  of  pulse  frequency  on  system  response.  System 
simulations  using  lower  sawtooth  waveform  frequencies 
indicate  stable  but  very  oscillatory  response  behavior.  It 
is  recognized  that  solid  state  power  switching 
characteristics  pose  a  limitation  on  the  maximum  realizable 
PWM  reference  frequency.  Therefore,  a  lOKHz  pulse 
frequency  is  selected  on  the  basis  of  response  smoothing 
and  hardware  constraints. 

The  selection  of  simulation  step  size  is  largely 
dependent  upon  the  reference  sawtooth  waveform  frequency. 
The  Nyquist  rate  determines  the  minimum  sampling  frequency 
required  to  reconstruct  the  assumed  bandlimited  sawtooth 
waveform.  If  the  step  size  is  chosen  less  than  one-half  of 
the  reciprocal  of  the  highest  significant  frequency 
component  (f  )  of  the  sawtooth  waveform's  Fourier 
transform,  then  aliasing  will  be  avoided  [Ref. 10]. 


Equations  5.3  and  5.4  determine  the  Nyquist  sampling  period 
(Ts)  of  a  periodic  sawtooth  waveform  of  period  Tp  and 
amplitude  em- 

H  (f)  =  fTp  Em  te“3  2*ft  dt  (5.3) 

J  0  ^p 

Ts  =  1/(2 fc)  =  50  Msec  (5.4) 

However,  simulation  based  on  the  Nyquist  rate  is 
observed  to  be  inadequate  and  does  not  provide  accurate 
pulse  width  modulation  of  error  signals.  The  full  range  of 
the  sawtooth  response  (0<VREF<1)  must  be  reconstructed  in 
the  simulation  to  support  modulation  of  small  amplitude 
error  signals.  Observation  of  computed  results  indicates 
that  a  minimum  simulation  step  size  of  an  order  of 
magnitude  less  than  the  PWM  pulse  period  is  required  for 
accurate  simulation. 

PWM  amplifier  gain  determines  the  region  of  pseudo 
linear  operation.  Consequently,  large  gains  result  in  hard 
response  characteristics  near  steady  state,  while  low  gains 
allow  soft  behavior.  The  interaction  of  PWM  frequency  and 
gain  may  result  in  unacceptable  residual  oscillations  and 
ballistic  overshoot  conditions.  This  self  excited 
oscillation,  or  limit  cycle,  is  commonly  associated  with 
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VI.  PRELIMINARY  PHASE  PLANE  DESIGN 


A.  BACKGROUND 

The  highly  nonlinear  and  discontinuous  nature  of  a 
pulse  width  modulated  position  controller  precludes  the  use 
of  most  classical  stability  analysis  methods.  Computer 
simulation  lends  itself  well  to  simple  time  response 
analysis,  but  restriction  to  such  a  method  often  masks  many 
of  the  underlying  characteristics  which  determine  a 
system's  general  behavior.  Nonlinear  controllers  are  most 
often  analyzed  with  either  describing  function  or  phase 
plane  techniques.  The  describing  function  is  a  frequency 
response  method  which  ultimately  determines  transfer 
function  characteristics  of  the  control  system.  However, 
the  discontinuous  nature  of  pulse  width  modulation  limits 
the  effectiveness  of  the  describing  function.  Phase  plane 
methods,  on  the  other  hand,  are  well  suited  to  handle  the 
PWM  stability  problem  provided  that  a  second  order  model  is 
applicable  and  the  methods  are  complemented  by  numerical 
simulation  of  the  time  response  of  state  trajectories. 

The  underlying  premise  of  analyzing  a  second  order 
system  in  the  phase  plane  is  that  linear  and  nonlinear 
components  of  its  characteristic  differential  equation  can 
be  partitioned.  Consider  the  general  form  of  a  second 


order  differential  equation  describing  the  response  of  e(t) 
and  given  by  Equation  6.1. 


e  +  f(e,e)  =  0 


(6.1) 


The  term  f(e,e)  is  a  nonlinear  function  of  e(t)  and 
e(t)  when  equation  6.1  describes  the  fin  actuator's 


performance . 


Rather  than  studying  e(t)  and  e(t) 


parametrically,  the  composite  function  e(e(t))  can  be 
determined  and  studied  graphically.  The  phase  plane 
portrait  of  4(t)  versus  e(t)  bears  a  wealth  of  information 
describing  a  system's  dynamics  which  is  otherwise  lost  in 
parametric  analysis  of  the  time  solutions. 

The  intent  of  this  chapter  is  to  develop  the  phase 
plane  method  of  analysis  as  a  primary  tool  for  studying  the 
dynamics  associated  with  position  control  of  brushless  dc 


motors . 


Additionally,  preliminary  values  for  design 


parameters  will  be  determined  based  on  system  performance 


criteria . 


B.  LINEAR  APPROXIMATION 

State  space  methods  associated  with  phase  plane 
portrait  development  are  not  well  suited  for  analysis  of 
the  detailed  brushless  dc  motor  model.  Such  an  approach 
involves  the  use  of  a  third  order  model  with  very  stiff 
dynamics  and  would  be  computationally  cumbersome  and 


inefficient. 


However,  the  detailed  model  may  be 


approximated  by  the  linear  lumped  parameter  third  ord 
model  shown  in  Figure  6.1.  Average  system  parameters  f 
the  typical  motor  used  in  this  study  are  given  in  Table  II 


f  -hSj 


Figure  6.1  Third  Order  Lumped  Parameter  Model 

TABLE  II 

AVERAGE  SYSTEM  PARAMETERS 


Viscous  Friction 

f 

.  01 

[oz-in/secl 

Motor  Inertia 

J 

.001 

[oz-in/sec2 ] 

Equiv  Resistance 

R 

9.7 

[ ohms ] 

Equiv  Inductance 

L 

.  0016 

[henries] 

Torque  Constant 

kt 

15 . 9 

[ oz-in/amp ] 

Back  EMF  Constant 

kb 

.  112 

[volts/ rad/ sec ] 

The  lumped  parameter  model's  validity  as  an  acceptable 
representation  of  the  3-phase,  4-pole  brushless  dc  motor 
may  be  demonstrated  using  analytic  and  computer  simulation 
methods.  The  closed  loop  transfer  function  describing  the 


block  structure  of  Figure  6.1  for  n(s)/Ea(s)  is  given  by 
Equation  6.2. 


Qlsj  = _ Kt _  (6.2) 

Ea(s)  (R  +  sL)  (f  +  sJ)  +  KtKb 

For  a  step  input  magnitude  of  Ea  =  150v,  steady  state 
output  can  be  obtained  using  the  final  value  theorem.  The 
steady  state  velocity  (wss)  is  determined  in  Equation  6.3. 

u>ss  =  _ E  Kt _  =  127  0  rad/sec  (6.3) 

fR  +  KtKb 

Assuming  a  10:1  mechanical  transmission  speed 
reduction,  velocity  may  be  converted  from  rad/sec  to  fin- 
deg/sec. 


ufss=(1270  rad)  (57.3  deg)  ( 0 . 1) =7277  fin-dea 
sec  rad  sec 


Motor  current  is  also  of  interest  in  the  verification 
of  the  averaged  parameter  model  and  the  transfer  function 
I(s)/Ea(s)  is  given  by  Equation  6.4. 

I  (s)  =  _ f  +sJ _  (6.4) 

Ea(s)  (R+sL)  (f+sJ)  *  KtKb 
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Again,  using  a  step  input  of  magnitude  Ea  =  l5Cv, 
steady  state  current  is  obtained  using  the  final  value 
theorem  and  is  calculated  in  Equation  6.5. 

Iss  =  _ E a  f  =  0.79  amps  (6.5) 

fR  +  KtKb 

Velocity  and  current  response  characteristics  of  both  the 
third  order  lumped  parameter  model  and  the  detailed 
brushless  dc  motor  model  are  simulated  using  programs 
listed  in  Appendices  A  and  C,  respectively,  and  the  results 
for  fin  velocity  and  current  response  are  illustrated  in 
Figures  6.2  through  6.5.  Simulated  response 

characteristics  support  analytically  determined  steady 
state  behavior  of  the  third  order  lumped  parameter  model. 
The  ripple  component  in  the  motor  current  caused  by  back 
emf  generation  in  the  brushless  dc  motor  constitutes  the 
principal  difference  in  performance  between  the  two  models. 
General  performance  similitude  indicates  the  brushless  dc 
motor  may  be  accurately  represented  with  respect  to  its 
mechanical  and  electrical  response  using  an  averaged 
parameter  model. 

Although  phase  space  methods  support  solution  of  third 
order  systems,  the  extra  simulation  time  and  programming 
effort  involved  do  not  justify  inclusion  of  a  third 
dimension  in  the  portrait  of  this  system.  The  electrical 


OPEN  LOOP  FIN  VELOCITT  STEP  RESPONSE 
THIRD  ORDER  MODEL 


and  mechanical  time  constants  of  the  motor  are  determiner 
by  Equations  6.6  and  6.7. 


•£  =  L  =  .0016  h  = 
R  9 . 70 


.000165  sec 


-  i  - 


.001  foz-in/s-)  =  0.1  sec 
. 01  ( oz-in/s) 


(6.6) 


(6.7; 


Clearly,  the  mechanical  time  constant  dominates  general 


system 


response  and  results  in  low  pass  behavior. 


Neglecting  the  fast  time  constant,  that  is,  assuming  no 
circuit  inductance,  the  system  performance  should  remain 
virtually  unchanged.  This  reduced  order  model  is  shown  in 
Figure  6.6  and  can  be  verified  as  a  legitimate  substitute 
for  the  third  order  model. 


f+SJ 


Equation  6.8  gives  the  closed  loop  transfer  function 
relationship  describing  the  reduced  order  model. 

\'i(  s)  =  _ Kt/JR  (6.8) 

Ea  ( s)  s  +  fR  +  KrpK^ 

JR 


The  final  value  theorem  is  used  to  determine  the  steady- 
state  velocity  when  a  step  amplitude  Ea  =  150v  is  applied. 

u>ss  =  Kt  E  =  1270  rad  -  CJSS=7277  f in-deg  (6.9) 
fR+KTKB  sec  sec 

The  motor  current  response  start-up  performance  is 
significantly  affected  by  the  removal  of  circuit  inductance 
and  its  associated  lag,  but  retains  similar  steady  state 
characteristics  as  determined  by  Equations  6.10  and  6.11 
and  illustrated  in  Figures  6.7  and  6.8. 

I  (s)  =  _ f  +sJ _  (6.1' 

Ea(s)  R  (f+sJ)  +  KjKg 


Iss  =  _ Ea  f  =  0.79  amps 

fR  +  lOpKg 

Table  III  summarizes  perform  ir 
detailed  model  of  the  brush., 
linear  approximation, 
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Figure  6.7  Reduced  Order  Model  Fin  Velocity  Step  Response 


Figure  6.8  Reduced  Order  Model  Motor  Current  Step  Response 
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Correlation  is  very  strong  between  the  detailed  and  reduced 
order  models,  substantiating  its  use. 


TABLE  III 


LINEAR  APPROXIMATION  VALIDATION 


Brushless 

DC  Motor 

Third  Order 
ADDroximation 

Reduced  Order 
ADDroximation 

nss 

[  °f in/sec] 

7670 

7277 

7277 

Iss 

[amps] 

1.4  (avg)t 

0.79 

0.79 

^-sel 

-tie  [sec] 

r±  ?%> 

.0275 

.0225 

.  0225 

xpeak  tainPs) 

14 . 59 

14 .20 

15.5 

Mi 

s  [sec] 
31-90%) 

.0145 

.0118 

.  0120 

I 
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C .  DEVELOPMENT 

The  computer  aided  phase  plane  program  developed  for 
analyzing  this  system  is  listed  in  Appendix  D  and 
graphically  superpositions  the  simulated  time  dependent 
trajectory  and  the  state  space  solutions  for  a  sufficiently 
representative  region  of  values  of  e  and  e.  The 
analytically  determined  state  space  solutions  are 
illustrated  as  slope  markers  which  indicate  the 
instantaneous  slopes  of  e(e(t))  at  any  condition  (e,e).  If 
the  range  of  e  and  e  to  be  examined  is  reasonably 

1  Steady  state  conditions  not  reached  at  t  -  0  3  sec  Extended 
simulation  reveals  Iss(t-0.05  sec)  -1.1  amp 


representative  of  the  normal  operating  conditions  of  the 
system,  stability  may  be  validated  by  the  exclusion  of  any 
singular  points,  areas  of  local  convergence,  or  areas  of 
divergence.  The  criterion  for  stability  in  this  design  is 
absolute  convergence  to  a  stable  equilibrium  point 
representing  steady  state  conditions  or,  as  is  common  in 
many  nonlinear  systems,  convergence  to  a  limit  cycle  about 
steady  state. 

A  limit  cycle  is  an  isolated  closed  path  or  trajectory 
in  the  phase  plane  and  describes  a  system's  self-excited 
oscillation  [Ref. 11].  If  the  limit  cycle  is  unstable,  the 
closed  loop  path  constitutes  the  boundary  between  stable 
and  unstable  regions.  For  a  stable  limit  cycle, 
trajectories  outside  and  in  the  vicinity  of  a  stable  limit 
cycle  will  converge  to  it,  while  those  trajectories  inside 
will  diverge  to  the  limit  cycle.  Limit  cycle  behavior  is 
anticipated  in  pulse  width  modulated  position  control  of 
the  brushless  dc  motor  due  to  inherent  time  delay  in 
switching  and  is  further  investigated  in  this  chapter. 

A  simulated  trajectory  represents  actual  system 
performance  over  time  when  specific  initial  conditions  are 
imposed.  While  the  trajectory  offers  tremendous  insight 
into  the  system's  dynamics  for  specific  response 
conditions,  the  unique  value  of  phase  plane  analysis  lies 
in  the  general  state  space  solution  presented  in  the  phase 
plane  portrait.  Figure  6.9  illustrates  the  reduced  order 


Figure  6.9  Closed  Loop  Reduced  Order  Model  State  Diagram 


The  system's  state  equations  are  developed  for  the 
purpose  of  defining  instantaneous  slope  vectors  (7)  as 
functions  of  error  (e)  and  error  rate  (e) . 


r?  =  f(e,e)  =  d  eft) 


(6.12) 


Fin  position  (0FIN)  in  degrees  is  assigned  the  state 
variable  x1.  Its  derivative  state  (wFIN)  in  fin-deg/sec  is 


To  describe  higher  order  state  variables,  it  is 
necessary  to  introduce  and  apply  a  scalar  transmission 
factor  (fi°)  which  converts  units  from  Motor  Radians  to  Fin 
Degrees . 

0°  =  n  180°  (6.14) 


The  variable  "n"  of  Equation  6.14  is  the  motor  to  fin 


mechanical  transmission  gear  ratio  and  is  assumed  to  be  0.1 
in  this  study.  Angular  acceleration  of  the  fin  in  deg/sec2 
is  given  by  Equation  6.15. 
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general  behavior  of  the  motor,  it  is  solely  inadequate  to 
characterize  the  overall  behavior  of  the  system.  Ramp 
response  analysis  more  completely  describes  the  motor's 
dynamic  positioning  performance.  Using  the  phase  plane 
simulation  developed  for  this  study,  a  ramp  input  whose 
time  dependence  is  scaled  by  its  slope  (r)  is  used  to 


evaluate  system  tracking  performance. 


Step  response 


analysis  is  performed  by  describing  initial  perturbation 
conditions  (e(0),e(0))  and  zeroing  the  ramp  slope. 


e  =  r  t  -  Kp  x1 


(6.16) 


Differentiating  Equation  6.16  yields  the  system's  error 


rate,  e. 


e  =  r  -  Kp  Xj 


(6.17) 


Manipulation  of  these  equations  of  state  is  required  to 
determine  expressions  for  x2  and  x2  solely  in  terms  of  e 
and  e.  Equations  6.17  may  be  rewritten  as  Equation  6.18. 


x2  " 


(6.18) 


Substitution  of  Equation  6.18  into  6.15  yields  Equation 


6.19. 


. . 


Finally,  the  instantaneous  slope  function  (7)  is  given 
by  Equation  6.20,  and  is  composed  of  natural  and  forced 


components . 

7  =  /(e,e)  =  d . Slfcl  =  '  _ Kp_J£2  ■  “  Kp  x2/e 

d  e (t)  r-KpX2 

7  =  -0°  KjKr  VIN(e.e)  +  (e-rUKrKB+fR).  (6.20) 

JR  & 

The  slope  function  (7)  is  linear  in  terms  of  e  and  e, 
except  for  the  VIN(e,&)  term.  The  nonlinearity  arises  from 
transfer  function  characteristics  of  the  pulse  width 
modulator.  Because  of  the  distinct  segregation  of  linear 
and  nonlinear  elements,  however,  the  model  may  be 
approximated  as  a  piecewise  linear  system.  The  phase  plane 
is  subdivided  into  several  regions  whose  commonalty  is 
local  linear  operation.  These  regions  are  graphically 
bounded  by  lines  of  discontinuity  on  the  phase  plane 
portrait.  Table  IV  describes  the  five  piecewise  continuous 
regions  of  operation  associated  with  saturation  amplifier 
and  PWM  E'jrvo  control.  The  use  of  relay  control  involves 
regions  1,  4,  and  5  only. 


Excluding  dead  zone  error,  the  steady  state  error,  ess, 
of  this  Type  1  system  is  of  finite  value  for  ramp  response 
and  zero  when  stepped.  ess  is  determined  by  Equation  6.21 
and  permits  correct  ramp  response  prediction  using  state 
space  solution  techniques. 

Ky  =  lim  s  r  r(s)  1 
s-0  l+G(s)H(s) 

e  =  i  *  r ( fR+KpKp^  +  r  Kv  +  Dead  Zone  (6.21) 

Ky,  0‘Kj.KpK^JVlN  Kp 

Ka  is  the  amplifier  gain  associated  with  the  nonlinear 
controller.  KpwM,  as  defined  in  Chapter  V,  is  substituted 
for  Ka  when  pulse  width  modulation  is  employed. 

Interpretation  of  Equation  6.21  describes  the  effects 
of  amplifier  gain  on  ess.  If  Ka  is  infinitely  large,  such 
as  in -the  case  of  an  ideal  relay,  the  steady  state  error  is 
minimized  and  is  approximated  by  Equation  6.22. 

ess( relay)  »  i_JSv  +  Dead  Zone  (6.22) 

KP 

However,  as  Ka  is  reduced,  the  first  term  of  Equation 
6.21  bears  more  significance  and  the  steady  state  error  is 
increased.  Thus,  system  accuracy  is  readily  ascertained 


using  analytical  methods  and  is  presented  for  comparison 


with  the  simulated  trajectory  as  an  asterisk  (”*")  on  the 
phase  plane  portrait. 

As  discussed  previously,  the  output  of  the  PWM  is 
either  0  or  150v.  However,  the  pulse  duration  is  a 
nonlinear  function  of  error.  Since  the  pulse  width 
modulator  is  described  in  terms  of  e  and  e,  as  well  as  by 
time,-  difficulty  exists  in  trying  to  illustrate  “three 
dimensional  characteristics  on  a  two  dimensional  phase 
plane.  However,  the  nonlinear  dependency  on  time  may  be 
alleviated  through  linear  approximation  methods.  This  is 
accomplished  by  time  averaging  the  response  of  the  PWM. 
The  result  of  such  a  linearization  closely  approximates  the 
characteristics  of  a  saturating  amplifier.  Specifically, 
the  function  which  describes  the  average  output  of  these 
two  nonlinear  elements  is  the  same.  The  average  dc  voltage 
of  the  PWM  is  defined  by  Equation  6.23. 


vdc  -  i  r  1  vout  dt=Pulse  Duty  Cycle*150v  (6.23) 

T  J  0 


The  variable  "T"  represents  the  period  of  the  PWM's 
pulse  cycle. 

The  instantaneous  error  of  the  system  is  nonlinearly 
scaled  by  the  PWM  amplifier  gain  (KpwM)  and  was  discussed 
in  detail  in  Chapter  V  where  essentially,  error  undergoes 
normalized  saturation  amplification.  The  normalized  value 


sww 


of  amplified  error  is  the  same  as  the  pulsed  voltage  output 
duty  cycle  of  the  PWM. 

This  one-to-one  relationship  between  input  error  and 
output  voltage  circumvents  the  otherwise  required 
dependency  on  the  time  variable  to  describe  pulse  duration. 
The  phase  plane  portrait  of  a  saturating  amplifier  will  be 
used  to  predict  the  simulated  trajectory  of  the  pulse  width 
modulated  reduced  order  model.  It  must  be  kept  in  mind, 
however,  that  while  the  piecewise  continuous  saturating 
amplifier  provides  a  good  average  approximation  of  the 
PWM's  discontinuous  characteristics,  instantaneous 
deviations  will  exist. 

D.  SYSTEM  PERFORMANCE 

Four  principal  design  parameters  are  realistically 
available  for  optimizing  system  performance.  The  lumped 
parameters  of  the  reduced  order  model  preclude  variation  of 
actual  component  characteristics  of  the  brushless  dc  motor. 
Coefficients  for  position  and  velocity  feedback  (Kp  and 
Ky)  ,  pulse  width  modulation  amplifier  gain  (KpWM) ,  and  PWM 
pulse  frequency  (fPWM)  are  considered  free  parameters  in 
this  design  and  are  the  focus  of  study  in  this  section. 

Since  the  pulse  width  modulator's  performance  can  be 
most  clearly  evaluated  relative  to  ideal  conditions, 
analysis  of  the  system  using  a  similarly  configured 
saturating  amplifier  and  ideal  relay  are  initially 


considered. 


The  continuous  time  saturating  amplifier 


describes  the  PWM  with  very  high  amplifier  gain.  Identical 
simulation  conditions  are  imposed  on  each  system 
configuration.  Small  scale  step  response  is  attained  using 
an  initial  perturbation  of  3°.  The  pulse  width  modulator  is 
configured  with  intentionally  low  values  of  amplifier  gain 
and  pulsing  frequency  to  accentuate  their  effects  on  system 
performance.  For  similar  reasons,  velocity  feedback  is  not 
used  in  this  illustrative  trial.  A  relatively  large  dead 
zone  of  ±0.25°  is  simulated  to  facilitate  observation  of  the 
system's  natural  response.  Phase  plane  characteristics  of 
PWM,  relay,  and  saturating  amplifier  controlled  systems  for 
a  step  input  are  shown  in  Figures  6.10  through  6.12, 
respectively. 

Each  of  the  three  controller  configurations  display 
identical  response  characteristics  in  the  dead  zone  and 
saturation  regions.  This  is  anticipated  since,  in  these 
regions,  all  three  nonlinear  controllers  are  characterized 
by  either  0  or  150  volts  of  continuous  output.  It  is 
interesting  to  note  that  the  PWM  model  is  unaffected  by 
pulsing  frequency  in  these  regions.  This  is  due  to  the 
system  error  being  outside  of  the  linear  range  of 
modulation  and  thus  resulting  in  continuous  modulation  duty 
cycles  of  0  or  100%.  The  linear  region  of  operation  is 
unique  to  the  saturating  amplifier  and  PWM  controlled 
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Figure  6.11  Phase  Plane  /  Equivalent  Relay  Controller 


:  PLANE  CHARACTERISTICS  (SAT  AMP  m/  DEADBAND) 


lyl 


o 

CD 

a 

0 

CD 

CO 

CD 

CD 

CD 

O 

CD 

CO 

a 

CD 

O 

o 

CD 

CO 

Q_ 

co 

=t* 

CD 

<=> 

LD 

CD 

LU 

CD 

CD 

CD 

CD 

OJ 

LO 

H— 

• 

■ 

• 

■ 

• 

• 

QC 

CO 

CD 

CD 

CD 

CD 

CD 

CX 

2d 

-4-* 

D 

Ql 

CO 

C 

<D 

£ 

CD 

m  rH 

H 

*+- 

1— 

o 

CD 

c. 

Cl 

Cl 

O 

D) 

Os 

-*-■> 

CL- 

D»- 

OD 

CE 

1 — 

to 

CO 

DC 

Dd 

LU 

CO 

/  /  / 
11/ 
/  /  / 
/  /“/ 
/  /  / 
/  /  / 
111 
i  1  l 
l  l  i 
i.  i .  i 
l  i  l 
l-l-  <■ 
i  i  l 
1  1  ( 

1  1  l 
1  1  t 
i  L  \ 
i  \  \ 

L  'V  V 
\  \  \ 


/  /  /  /  ^  ^  »- 

/  /  /  /  k' 

V  S  >"r^  V 

1  /  1  1  S  S  ^ 

1  1  1  1  s  s  ^ 

1  1  1  1  1  Ss<? 

1111  l/l  ^ 

1  l  1  l  fi  1  1 
t  J_  _1  jilj.  / 
i  I  1  il  ~i  l  fl 

I-  < -l-  J-l-  -lU- 4 

i  l  1  \  \  v\\_T 

\  \ 


1  1  l 


1  l  \  UWs, 

1  \  \  \\s  %.  -I 

\  \  \  \  \Nvcr- 
\  \  \  \  n  Orrr 
v  \  s  v_: 

\  \  \  \  N  ^  ^  ^ 


^  \  \ 

■  ^  *^v  \  \ 

v.  _0\\ 

^  V  \  \\ 

^  ^  \  \  V 
V  \  \  \ 

"^NN  \  \  ^ 
M\\  U 
Y  \M  I  T 
7  -Hf  -f-  * -f-  f 

I?  if  i  t  r  f  r 
rfYfVfh'f 
iyr  t  i  rj  i  t 

^  /  /  y  r  r  r 

**  S  t/f  /  /  / 
f  S  /  / 
^  s _s  /  s  / 

^  ^  '  s  /  f  / 
--  >•/*///  / 


\  \ 
\  \ 

.V  A 
\  A 
\  \ 
\  \ 
\  \ 
\  T 
f  T 

-h  t 
l  1 
?  ~1 
i  r 
/  ; 
r  r 
t  r 
/  / 

.  /  j 
/  / 
/  / 


01*  lOu  3 


systems.  Although  the  phase  plane  portraits  represent..-.; 
these  two  configurations  are  defined  identically,  tr.e 
relatively  low  pulsing  frequency  exaggerates  the  effects  or 
the  discontinuous  PWM.  Specifically,  the  pulsing  period 
used  in  the  response  of  Figure  6.10  is  sufficiently  large 
so  as  to  cause  undesirably  long  durations  of  fcrced  and 
natural  response  for  a  determined  duty  cycle.  '  The 
increased  significance  of  the  time  dimension  in  the  phase 
plane  results  in  time  averaging  being  a  less  valid 
approximation  of  actual  performance.  If  the  trajectory  in 
the  linear  region  of  the  PWM  of  Figure  6.10  was  time 
averaged,  it  would  describe  the  same  response  as  the 
saturating  amplifier  shown  in  Figure  6.12.  However,  the 
instantaneous  and  erratic  trajectory  of  Figure  6.10  follows 
the  path  of  the  relay  of  Figure  6.11  while  being  forced 
with  150  volts  and,  during  the  relaxed  mode,  the  path  of 
natural  response  of  the  dead  zone.  Since  the  continuous 
amplifier  provides  ideally  smooth  response  behavior,  a 
maximum  value  of  pulsing  frequency  is  desired.  Frequency 
considerations  are  discussed  in  subsequent  trials. 

The  relative  "softness’*  of  the  PWM’s  settling  behavior 
is  due  to  its  relatively  low  value  of  amplifier  gain. 
Small  error  values  receive  inadequate  gain  to  provide  the 
stiff  control  typically  desired  in  high  performance 


applications.  Increasing  amplifier  gain  approximates  the 
stiff  response  of  the  relay  shown  in  Figure  6.11. 

The  first  design  parameter  to  be  independently  examined 
in  the  phase  plane  was  PWM  pulse  frequency.  Although  a 
maximum  pulsing  frequency  of  lOKHz  was  selected  in  Chapter 
V  based  on  hardware  limitations,  the  effect  of  pulse 
duration  on  system  response  is  significant  and  deserves 
attention.  Figures  6.13  through  6.16  illustrate  the 
effects  of  varying  with  values  of  1,  5,  10,  &  20KHz. 
Amplifier  gain  remains  small  so  as  to  expand  the  linear 
region  where  pulsing  frequency  affects  the  response.  All 
observations  made  during  the  trial  describe  the  simulated 
trajectory  in  the  linear  region  of  operation. 

Figure  6.13  shows  the  unacceptable  consequences  of 
using  an  insufficient  /pwM*  Poor  correlation  between 
portrait  and  trajectory  characteristics  implies  the  invalid 
time  averaging  is  attributed  to  excessive  pulse  duration. 
The  response  is  smoothed  with  higher  pulsing  frequencies. 
However,  the  difference  between  the  10  KHz  and  20  KHz 
responses  is  negligible,  indicating  that  very  high 
frequencies  are  not  required  for  the  linear  approximation 
of  continuous  saturation  amplification  to  be  valid. 
Therefore,  10  KHz  was  selected  as  optimum  for  PWM  pulsing 
frequency. 
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Figure  6.13  Phase  Plane  Response  of  lKHz  PWM  Controller 
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Figure  6.15  Phase  Plane  Response  of  lOKHz  PWM  Controller 
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Amplifier  gain  determines  to  a  large  extent  the 
system's  responsiveness.  Figures  6.17  through  6.19 
illustrate  system  behavior  ranging  from  "soft"  to  "stiff". 
Relatively  soft  behavior  shown  in  Figure  6.17  is  due  to  the 
use  of  an  amplifier  gain  of  0.1  and  is  characterized  by  a 
slow  oscillatory  transient.  Conversely,  stiff  conditions 
are  shown  in  Figure  6.19  and  are  attained  using  a  Kp^j  of 
10.0.  The  trajectory  resembles  the  response  of  the  relay 
shown  in  Figure  6.11  and  is  described  by  very  rapid 
"chattering"  of  the  motor  about  steady  state.  Finally, 
acceptable  responsiveness  is  achieved  using  a  gain  of  3.0 
as  illustrated  in  Figure  6.18  and,  therefore,  was  selected 
as  the  optimum  value  for  gain. 

A  pulsing  frequency  of  lOKHz  and  amplifier  gain  of  3 
were  independently  selected  by  observing  their  effects  on 
phase  plane  response  behavior.  However,  frequency  and  gain 
exhibit  coupled  effects  which  result  in  limit  cycle 
behavior.  While  limit  cycles  may  not  be  eliminated  solely 
through  the  selection  of  KpwM  and  fpwM,  they  may  be 
minimized.  Steady  state  oscillations  are  small  in 
amplitude  for  the  parameter  selection  described.  However, 
when  gain  is  increased  and  frequency  decreased, 
unacceptable  magnification  of  limit  cycle  behavior  is 
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Figure  6.17  Phase  Plane  Response  of  KPWM=.l  PWM  Controller 
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Figure  6.19  Phase  Plane  Response  of  KpWM=10  PWM  Controller 
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realized.  Figure  6.20  illustrates  the  effect  of  increasing 
amplifier  gain  to  50  while  maintaining  the  pulsing 
frequency  at  lOKHz.  Figure  6.21  shows  exaggerated  effects 
achieved  by  reducing  frequency  to  lKHz  with  gain  fixed  at 
3.  The  region  shown  by  the  circle  is  discussed  below. 

The  extent  of  limit  cycle  behavior  is  dependent  on  the 
amount  of  electromotive  energy  provided  to  the  motor  during 
the  delay  associated  with  the  PWM  pulsing  period.  For 
example,  consider  the  low  trajectory  of  Figure  6.21. 
The  delay  observed  in  actual  controller  switching  caused  by 
the  finite  pulse  duration  which  extends  the  state  space 
forcing  vector  from  one  region  into  another.  The  delay 
highlighted  by  the  circular  region  in  Figure  6.21  may  be 
graphically  observed  in  Figure  6.22  by  examining  the  pulse 
width  modulator's  time  response  in  the  the  proximity  of 
switching.  Once  a  pulse's  duty  cycle  is  set,  the 
controller  is  temporarily  insensitized  to  operating 
conditions  for  the  remainder  of  the  pulse  period. 
Interpretation  of  Figure  6.22  confirms  that  limit  cycle 
behavior  may  be  reduced  by  increasing  pulsing  frequency  or 
decreasing  gain. 
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The  final  phase  of  this  preliminary  design  involves 
selection  of  feedback  gain  coefficients  Kp  and  K^.  For 
analytical  simplicity,  unity  feedback  (Kp  =  1)  is  chosen. 
Velocity  feedback  is  selected  relative  to  Kp  and  determines 
the  extent  of  system  damping.  The  feedback  design 
performed  in  the  phase  plane  does  not  incorporate  dead  zone 
in  the  controller  for  the  sole  purpose  of  enhancing  the 
illustration  of  switching  line  behavior.  Specifically, 
reticence,  or  "chattering" ,  is  not  desired  and  might  be 
undetected  if  dead  zone  is  applied  in  this  preliminary 
stage  of  the  design. 

Lines  of  discontinuity  acquire  a  finite  slope  in  the 
phase  plane  when  velocity  feedback  is  used.  The  slope  is 
the  feedback  ratio,  -Kp/Ky,  and  applies  to  all  region 
boundaries.  Trajectory  interaction  with  the  switching  line 
provides  the  definition  for  damping  criteria.  For 
continuous  regulators,  sufficiently  large  velocity  feedback 
results  in  overdamped  behavior  characterized  by  no 
transient  oscillation.  The  system  trajectory  should 
approach,  but  not  intersect,  the  switching  line. 
Overdamping  discontinuous  controllers,  such  as  the  PWM,  is 
characterized  by  excessive  reticence  and  slow 
responsiveness.  If  velocity  feedback  gam  is  small  enough, 
then  the  system  trajectory  will  intersect  the  switching 


line  and  yield  an  underdamped  oscillatory  transient.  The 
intersection  of  the  e-axis  by  the  trajectory  defines 
transient  overshoot.  Critical  damping  is  described  by  the 
condition  where  the  trajectory  coincides  with  the  switching 
line.  The  phase  plane  provides  a  graphic  method  of 
selection  of  damping  characteristics.  It  is  observed  that 
slope  markers,  which  represent  system  response 
characteristics  unique  to  specific  operating  conditions, 
are  independent  of  K v.  Furthermore,  region  #1  of  Table  IV 
describes  the  system's  natural  response  found  in  dead  zone 
operation.  Alignment  of  the  dependent  switching  line 
(dashed  line)  with  slope  markers  in  the  dead  zone  is  shown 
in  the  phase  plane  portrait  of  Figure  6.23  and  results  in 
critical  damping.  The  switching  line  slope  may  be 
increased  by  decreasing  Ky,  resulting  in  underdamped 
conditions.  Conversely,  increasing  Ky  tends  the  switching 
line  towards  horizontal  and  yields  overdamped  behavior. 

Figure  6.24  illustrates  overdamped  step  response 
behavior  attained  with  a  velocity  feedback  gain  coefficient 
of  Ky^O.Ol.  The  trajectory  is  characterized  by  excessive 
"chattering"  while  it  slowly  traverses  the  switching  line 
and  is  associated  with  large  Ky.  Near  critical  damping  is 
shown  in  Figure  6.25  where  1^=0.005  and  is  characterized 
by  slow  transient  behavior  along  the  switching  line.  This 
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Figure  6.25  Phase  Plane  /  Critically  Damped  Step  Response 


system  configuration  provides  optimal  position  control  in 
terms  o.  energy  requirements,  but  is  not  well  suited  to 
this  high  performance  tracking  application.  Figure  6.26 
illustrates  underdamped  response  behavior  associated  with  a 
velocity  feedback  gain  coefficient  of  1^=0.0005.  The 
trajectory  is  oscillatory  and  exhibits  overshoot,  but 
provides  highly  responsive  transient  behavior. 
Characteristics  observed  in  the  phase  plane  of  Figure  6.27 
describe  good  step  response  performance  of  fin  position  for 
the  linearly  approximated  system  when  1^=0.001  and  support 
the  selection  of  this  velocity  feedback  gain  coefficient 
as  an  optimal  design  parameter  value.  The  slightly 
underdamped  response  shows  no  overshoot  and  has  a  fast 
settling  time.  Figures  6.28  and  6.29  show  agreement 
between  the  reduced  (2nd)  order  and  third  order  systems* 
step  time  response,  thereby  validating  results  attained  via 
the  phase  plane. 

The  phase  plane  described  by  e  and  e  for  step  response 
conditions  actually  describes  and  -wf^n.  The  plane 
may  readily  be  transformed  into  an  energy  plane,  where 
potential  energy  is  a  function  of  e  and  kinetic  energy  is  a 
function  of  e.  The  switching  line  which  passes  through  the 
steady  state  point  describes  conditions  of  locally 
maximized  kinetic  energy,  whereas  the  crossing  of  the  e- 
axis  describes  localized  minimum  kinetic  energy.  The 
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degree  of  response  stiffness  of  the  controller  is 
determined  by  the  amount  of  electromotive  energy  it 
provides  to  the  motor.  Increased  amplifier  gain  results  in 
greater  pulse  duty  cycles  for  given  system  conditions  and, 
hence,  greater  electromotive  energy  transmission.  The 
forced  harmonic  oscillation  frequency  also  increases  with 
amplifier  gain  and  results  in  greater  numbers  of  rotational 
reversals,  a  condition  to  be  avoided  whenever  possible. 

Ramp  response  analysis  is  also  supported  by  phase  plane 
methods  and  will  be  briefly  discussed.  The  natural 
response  component  of  the  slope  function  (r/)  described  by 
Equation  6.20  is  dependent  on  the  ramp  slope,  r.  When  r  is 
non-zero,  the  coordinates  (e,e)  do  not  linearly  transform 
to  (-sf  in'  “wf  i^  and  the  ener9Y  plane  correlation  is  not 
valid.  Additionally,  the  phase  plane  is  no  longer 
symmetric  about  the  e-axis.  Consequently,  the  ramp 
response  portrait  is  significantly  different  than  that  of 
the  step  response. 

The  underdamped  controller  whose  step  response  was 
determined  in  Figure  6.27  was  subjected  to  a-  ramp  input  of 
slope  r=3000  deg/sec.  The  phase  plane  trajectory  is 
illustrated  in  Figure  6.30,  characterized  by  similarly 
acceptable  response  behavior.  Steady  state  error  is 
analytically  determined  to  be  ess=3.14  by  equation  6.21. 
Figures  6.31  and  6.32  provide  the  ramp  time  responses  of 
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REDUCED  ORDER  LUMPED  PRRRHETER  MODEL 


the  second  and  third  order  lumped  parameter  models. 
Transient  behavior  is  rapid  and  steady  state  tracking 
accuracy  of  this  demanding  input  is  tolerable. 

Of  particular  i  ;erest  is  the  phase  plane 
representation  of  the  system's  dynamic  limitations  which 
describe  the  motor's  torque  capabilities.  Figure  6.33 
illustrates  the  case  where  the  system's  maximum  position 
tracking  rate  precludes  stable  convergence  when  a  ramp 

a 

input  of  r=10000  deg/sec  is  used.  At  steady  state,  the 
trajectory  becomes  asymptotic  to  the  horizontal  line  given 
by  Equation  6.24.  Steady  state  error  is  infinite, 
indicating  ramp  response  instability. 

ess  =  ^“wfsS(o.L. )  =104-7277=2623  f in-deg  (6.24) 

sec 

The  phasu  plane  has  been  used  extensively  in  this 
chapter  as  a  method  for  gaining  insight  of  the  controller's 
dynamics  and  for  selecting  preliminary  design  parameters. 
However,  two  important  final  design  considerations  remain 
unaddressed  and  are  the  focus  of  attention  in  Chapter  VII. 
Proper  design  of  this  electromechanical  system  requires 
compromise  between  system  performance  and  reliability  of 
electronic  components.  Additionally,  thorough  simulation 
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VII.  PARAMETER  OPTIMIZATION  BY  SIMULATION  METHOD 

A.  BACKGROUND 

Proper  design  of  a  position  controller  for  an 
electronically  commutated  cruise  missile  fin  actuator 
demands  consideration  of  the  system's  mechanical  response 
characteristics  and  the  associated  transient  environment 
imposed  on  its  solid  state  components.  Preliminary  design 
based  solely  on  mechanical  performance  was  presented  in  the 
preceeding  chapter.  Electrical  transient  behavior  of  the 
system  was  developed  and  studied  in  Chapters  III  and  IV. 
The  central  theme  of  this  chapter  is  investigation  of 
electromechanical  design  considerations,  where  compromise 
between  mechanical  performance  and  electronic  reliability 
is  required.  The  application  of  pulse  width  modulation  to 
position  control,  studied  in  Chapters  V  and  VI,  was  shown 
to  provide  the  broad  performance  range  necessary  to 
accomodate  electrical-mechanical  design  compromises  and, 
therefore,  was  selected  as  the  means  of  fin  actuation 
control  for  this  design. 

Design  parameters  independently  determined  in 
preceeding  chapters  are  summarized  in  Table  V  and  yield 
good  electrical  and  mechanical  performance  properties. 


These  values  serve  as  the  starting  point  in  the  final 
design. 


TABLE  V 

SUMMARY  OF  PRELIMINARY  DESIGN  PARAMETERS 


PWM  Amplifier 

Gain  (Kp^) 

3.0 

PWM  Pulsing 

Frequency  (fPWM) 

lOKHz 

PWM  Controller 

Dead  Zone  (DBAND) 

o 

o 

• 

o 

Velocity  Feedback 

Gain  Coefficient  (Ky) 

0.001 

Position  Feedback 

Gain  Coefficient  (Kp) 

1.0 

Bias  Threshold 

Voltage  Divider  % 

50% 

Commutation 

Offset  (THADV) 

0.0° 

Plugging 

Delay  (TDPLUG) 

500  jisec 

Decay  Rate 

Resistance  (RDADJ) 

3  n 

System  performance  design  conducted  in  Chapter  VI  was 
based  primarily  on  small  scale  step  response  analysis. 
Using  a  3°  fin  perturbation,  phase  plane  trajectories  of  the 
reduced  order  model  were  characterized  by  slightly 
underdamped  behavior.  No  overshoot  and  very  little 


transient  oscillation  were  noted.  A  relatively  large  scale 


ramp  response  (30008/sec)  was  also  studied  using  the  same 
design  criteria,  and  was  observed  to  behave  very 
acceptably.  The  validity  of  this  design  based  on  lumped 
parameter  modeling  is  initially  ascertained  through 
simulation  using  the  detailed  brushless  dc  motor  model 
listed  in  Appendix  A.  Subsequent  to  fine  adjustment  of 
design  parameters,  large  scale  step,  ramp,  and  sinusoidal 
response  analyses  are  performed  to  determine  the 
controller's  robustness. 

B.  SIMULATION 

Validation  of  the  small  scale  step  response  analysis 
performed  in  the  phase  plane  is  readily  accomplished 
through  simulation  using  the  detailed  model  listed  in 
Appendix  A.  While  small  scale  step  analysis  does  not 
accurately  represent  the  tracking  dynamics  encountered  in 
missile  flight  control,  it  does  provide  a  general  and 
convenient  standard  for  selection  of  controller  design 
parameters. 

1 •  Small  Scale  Step  Response 

Simulation  using  the  preliminary  design  parameters 
summarized  in  Table  V  duplicate  the  system  configuration 
selected  in  Chapter  VI.  In  addition  to  system  response 
verification,  observation  of  the  corresponding  electrical 
transient  behavior  is  afforded.  Figures  7.1  through  7.4 
illustrate  the  electromechanical  performance  of  the 
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preliminary  design  when  simulated  with  the  brushless  dc 
motor  model.  Figure  7.1  depicts  the  fin  position  response 
to  a  3°  step  input.  Of  particular  interest  is  the  presence 
of  a  2  5%  peak  overshoot,  which  was  not  predicted  by  the 
lumped  parameter  model  simulation.  Associated  with  the 
oscillatory  transient  are  a  relatively  large  current  demand 
exhibited  in  Figure  7.2  and  a  4C0  volt  spike  observed  in 
the  center  point  trajectory  of  Figure  7.3.  Torque  response 
characteristics  are  given  in  Figure  7.4  and  vividly  display 
the  relatively  long  duration  of  natural  response  due  to  the 
use  of  a  plugging  delay  time  (TDPLUG)  of  500^sec.  System 
relaxation  of  such  duration  invites  unacceptably  large 
degrees  of  ballistic  overshoot.  However,  plugging  delay  of 
some  extent  is  required  due  to  the  inevitable  requirement 
for  current  reversal  associated  with  forced  braking  of  the 
motor.  The  closed  loop  transient  analysis  performed  in 
Chapter  III  assumes  maximum  stiffness  in  the  controller's 
operation  and  employs  the  characteristics  of  an  ideal  relay 
to  simulate  such  behavior.  When  maximum  current  flow  is 
reversed,  there  is  an  understandable  need  for  dissipation 
of  excess  coil  energy.  However,  a  soft  controller  was 
determined  to  be  best  suited  in  the  preliminary  design  and 
pulse  width  modulation  using  an  amplifier  gain  (KpwM)  of  3 
was  selected.  The  resulting  buffering  action  provided  by 
the  controller  eliminates  the  need  for  a  lengthy  current 
decay  time  during  plugging.  Figures  7.5  through  7.8 


illustrate  the  small  scale  step  response  behavior  using  a 
reduced  TDPLUG  of  10  nsec.  No  overshoot  is  observed  in  the 
fin  position  step  response  shown  in  Figure  7.5  and  system 
behavior  is  virtually  identical  with  the  results  attained 


in  lumped  parameter  modeling. 


Hence,  the  linear 


approximations  required  by  phase  plane  design  methods  are 
validated  and  shown  to  be  an  effective  means  of  predicting 
system  performance.  Figure  7.6  indicates  substantial 
reduction  in  current  demand  when  the  plugging  delay  is 
decreased  since  system  recovery  from  ballistic  overshoot  is 
not  required.  A  peak  voltage  surge  of  only  100  volts  is 
experienced  at  the  center  connection  and  is  shown  in  Figure 
7.7.  Figure  7.8  illustrates  the  absence  of  any  detectable 
period  of  natural  motor  torque  response  associated  with 
plugging  delay. 

The  erratic  current  response  behavior  illustrated 
in  Figure  7.6  between  .003  and  .004  seconds  is  attributed 
to  the  periodic  forcing  nature  of  the  PWM  controller  as  the 
fin  position  settles.  Near  steady  state  conditions,  the 
PWM  pulse  duty  cycle  is  small  and  does  not  receive 
effective  filtering  by  the  system's  electrical  time 
constant.  Therefore,  the  electrically  developed  torque 
shown  in  Figure  7.8  is  also  affected  by  the  pulsation.  It 
is  observed,  however,  that  the  dominant  mechanical  low  pass 
characteristics  of  the  motor  filters  the  oscillation  and 


results  in  the  smooth  position  response  shown  in 
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Figure  7.5.  The  inclusion  of  a  ±.5°  dead  zone  decreases  the 
extent  of  this  forced  oscillation  and  is  described  in 
Figures  7.9  through  7.11.  Figure  7.9  portrays  the  fin 
position  step  response  with  the  inclusion  of  dead  zone. 
Steady  state  accuracy  is  compromised  in  a  manner 
proportionate  to  the  extent  of  dead  zone  employed.  The  fin 
position  passes  through  its  intended  steady  state  position 
of  0°  and  settles  at  .5°.  Once  again,  the  relatively  large 
region  allowed  for  natural  response  supports  ballistic 
overshoot  of  the  fin  position  and  causes  additional 
undesired  forced  braking  action.  Because  the  motor 
undergoes  commutation  switching  at  0°,  the  commutation  logic 
is  reverse  sequenced  and  results  in  current  reversal. 
Figure  7.10  indicates  reduced  susceptibility  of  the  motor 
current  to  the  pulsing  action  of  the  PWM  due  to  dead  zone, 
but  is  also  characterized  by  rapid  decay  of  current 
associated  with  the  interaction  of  plugging  and  commutation 
switching.  The  rapid  change  in  current  flow  is  responsible 
for  the  18  0  volt  spike  observed  in  the  center  connection 
voltage  response  of  Figure  7.11.  Analysis  of  small  scale 
step  response  indicates  that  inclusion  of  dead  zone  not 
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only  degrades  system  accuracy,  but  also  accentuates 
electrical  transients  due  to  the  increased  need  for  forced 


braking . 


Large  Scale  Step  Response 


Stability  of  nonlinear  systems  often  is  largely 
dependent  on  the  initial  conditions  imposed.  Simulation  of 
a  large  scale  step  response,  for  example,  might  be  expected 
to  display  different  response  characteristics  of  the 
brushless  dc  motor  fin  position  controller  than  have  been 
observed  using  a  small  step.  In  application,  it  is  highly 
unlikely  that  the  missile  command  guidance  would  command  a 
45°  fin  step.  However,  because  of  its  excessive  nature, 
such  a  simulation  was  conducted  for  purposes  of  evaluating 
benchmark  performance.  Figures  7.12  through  7.14  illustrate 
the  electromechanical  performance  of  the  brushless  dc  motor 
subjected  to  a  4  5°  step  input.  The  fin  position  response 
shown  in  Figure  7.12  indicates  a  15%  peak  overshoot  and  a 
comparatively  large  settling  time  of  0.02  seconds.  Both  of 
these  response  characteristics  are  highly  acceptable  and 
indicate  performance  robustness.  Figure  7.13  illustrates 
motor  current  large  scale  step  response  behavior.  Although 
average  current  demand  is  relatively  high  due  to  the  nature 
of  the  input,  the  current  response  is  very  well  behaved. 
Figure  7.14  shows  reasonable  Node  0  voltage  transients  in 
the  motor,  indicative  of  proper  commutation  operation  of 
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the  power  conditioner.  A  maximum  center  connection  voltage 
surge  of  120  volts  was  observed. 


3 .  Ramp  Response 

Since  the  cruise  missile  fin  actuator  behaves  as  a 
tracking  device,  a  dynamic  range  of  input  values  permit 
more  realistic  analysis  of  the  controller.  A  stiff  ramp 
input  signal  of  slope  3000  deg/sec  is  used  to  attain  the 
dynamic  response  behavior  of  the  actuator.  Similar 
analysis  was  previously  conducted  in  the  phase  plane  using 
the  lumped  parameter  model.  Although  ramp  response 
analysis  specifically  evaluates  the  positioning  device's 
ability  to  perform  as  a  constant  velocity  device,  it 
provides  rudimentary  dynamic  response  behavior  unavailable 
in  step  response  analysis.  Figures  7.15  through  7.19 
display  the  tracker's  dynamic  performance  characteristics 
simulated  using  a  relatively  demanding  ramp  input  of 
3000deg/sec.  Tracking  performance  is  illustrated  in  Figure 
7.15  and  very  similar  to  the  behavior  observed  using  lumped 
parameter  modeling.  Steady  state  error,  as  defined  in 
Chapter  VI,  is  observed  and  is  considered  to  be  acceptable 
for  this  design  application.  Although  the  system  is 
underdamped,  transient  oscillation  is  negligible  and  forced 
braking  is  kept  to  a  minimum.  Figure  7.16  gives  the  motor 
current  ramp  response  and  is  characterized  by  a  relatively 
high  current  demand.  Additionally,  significant  harmonic 
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oscillation  caused  by  PWM  pulsing  is  exhibited  near 
constant  velocity.  PWM  pulsing  is  more  clearly  shown  in 
the  torque  response  of  Figure  7.17,  where  transient  and 
steady  state  oscillation  also  are  exhibited.  A  center 
connection  peak  voltage  surge  of  150  volts  is  observed  in 
Figure  7.18.  The  voltage  response  of  Power  Transistor  #5 
is  illustrated  in  Figure  7.19.  The  pulsing  effects  of  the 
PWM  operating  at  low  duty  cycle  near  steady  state  are 
readily  observed  as  moderate  spiking  across  the  transistor. 
Although  this  ragged  forced  response  could  be  smoothed  with 
use  of  higher  pulsing  frequencies,  hardware  constraints 
preclude  such  implementation.  The  corresponding  voltage 
responses  shown  in  Figures  7.18  and  7.19  are  characterized 
by  high  frequency  voltage  transients  of  moderate  magnitude. 
Therefore,  despite  the  undesirable  pulsing  effects  of  the 
PWM,  the  ramp  response  characteristics  are  determined  to  be 
acceptable . 

4 .  Sinusoidal  Response 

The  final  and  most  realistic  simulation  performed 
evaluates  the  dynamic  tracking  performance  of  the  fin 
actuator  by  subjecting  the  controller  to  a  sinusoidal 
input.  The  ability  of  the  controller  to  track  sinusoidally 
varying  position  commands  demonstrates  true  tracking 
robustness.  To  simulate  typical  cruise  missile  command 


guidance  flight  correction  commands,  a  sine  wave  of 


amplitude  3°  and  frequency  of  100Hz  was  used  as  a  reference 


input , 


Figures  7.20  through  7.23  illustrate 


electromechanical  sine  wave  response  characteristics  of  the 
fin  actuator.  Good  tracking  characteristics  are  exhibited 
in  the  fin  position  response  of  Figure  7.20.  Although 
steady  state  error  varies  with  the  instantaneous  slope  of 
the  input,  it  is  acceptably  small  and  is  approximated  at  .3° 
at  the  sine's  point  of  inflection.  Figure  7.21  gives  the 
motor  current  sine  wave  response  and  indicates  considerable 
pulsing  activity  at  near  steady  state  conditions.  These 
pulses  are  realized  as  voltage  spikes  at  solid  state 
components  and  the  representative  conditions  at  power 
transistor  #5  are  illustrated  in  Figure  7.22.  However,  the 
spikes  are  sufficiently  small  (170  volts)  so  as  not  to 
degrade  solid  state  reliability.  Figure  7.23  shows  the 
center  point  trajectory  when  the  controller  is  subjected  to 
small  amplitude  sinusoidal  inputs.  A  peak  voltage  surge  of 
15  volts  is  highly  acceptable. 
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C.  FINAL  DESIGN 

It  has  been  demonstrated  through  simulation  that  the 
position  controller  final  design  parameters  specified  in 
Table  VI  provide  robust  operational  performance.  Demanding 
mechanical  performance  is  achieved  with  an  electronically 
sensitive  brushless  dc  motor  through  the  adaption  of  pulse 
width'  modulation.  The  transient  waveshaping  incorporated 
in  this  design  appeared  to  significantly  modify  the 
electrical  response  characteristics  when  independently 
studied.  However,  the  coupled  electrical-mechanical  design 
performed  in  this  chapter  diminishes  the  impact  of 
waveshaping  and  relies  most  heavily  on  the  soft  response 
characteristics  of  the  PWM.  Oscillation  due  to  low  duty 
cycle  pulse  width  modulation  is  apparent  during  near-steady 
state  conditions,  but  its  effects  are  filtered  by  the  low 
pass  characteristics  of  the  brushless  dc  motor. 


TABLE  VI 


SUMMARY  OF  FINAL  DESIGN  PARAMETERS 


PWM  Amplifier 

Gain  (Kp^) 

3.0 

PWM  Pulsing 

Frequency  (fPWM) 

lOKHz 

PWM  Controller 

Dead  Zone  (DBAND) 

0.0° 

Velocity  Feedback 

Gain  Coefficient  (K^) 

0.001 

Position  Feedback 

Gain  Coefficient  (Kp) 

1.0 

Bias  Threshold 

Voltage  Divider  % 

50% 

Commutation 

Offset  (THADV) 

0.0° 

Plugging 

Delay  (TDPLUG) 

10  fj,sec 

Decay  Rate 

Resistance  (RDADJ ) 

3  n 

VIII.  CONCLUSIONS  AND  RECOMMENDATIONS 


A.  CONCLUSIONS 

It  has  been  demonstrated  through  computer  simulation 
that  the  brushless  dc  motor  has  viable  application  in 
position  control.  The  electronically  demanding  environment 
associated  with  forced  braking  and  bi-directional  motor 
operation  requires  that  considerable  attention  be  given  to 
the  power  conditioner's  electrical  transient  response 
characteristics.  The  central  theme  presented  in  this  study 
involves  the  design  compromises  required  to  exploit  the 
intrinsic  high  performance  of  a  brushless  dc  motor  without 
sacrificing  operational  reliability  of  its  solid  state 
components.  This  study  advances  an  on-going  comprehensive 
development  effort  of  cruise  missile  fin  control  using 
electromechanical  actuation. 

Reduced  peak  voltage  conditions  associated  with 
commutation  switching  were  attained  through  transient 
current  waveshaping  techniques  involving  modification  of 
power  conditioner  circuitry.  Pulse  width  modulation  in 
closed  loop  position  control  was  observed  to  provide 
electrically  advantageous  response  buffering  during 
rotational  reversals  of  the  motor. 

System  performance  was  initially  evaluated  in  the  phase 
plane  and  preliminary  design  parameters  based  on  a  reduced 
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order  lumped  parameter  model  were  identified.  Composite 
analysis  of  the  electromechanical  actuator  was  conducted 
through  computer  simulation  using  the  detailed  model  of  the 
brushless  dc  motor  listed  in  Appendix  A.  Following  minor 
power  conditioning  parameter  adjustments,  simulated  results 
were  highly  consistent  with  system  performance  observed 
using  linear  approximation  methods  and  electrical  transient 
behavior  was  observed  to  be  very  satisfactory.  The 
controller  was  found  to  be  functionally  robust  based  on 
response  evaluation  using  small  and  large  step,  ramp,  and 
sinusoidal  inputs. 

The  four  pole  brushless  dc  motor  modeled  in  this  study 
is  based  on  typical  motor  specifications  and  limited 
physical  benchmark  measurements  of  this  motor  conducted  at 
NWC,  China  Lake.  Consequently,  validation  of  the  model  is 
limited  to  the  extent  of  available  performance  data. 
Ongoing  cruise  missile  fin  actuator  design  efforts  using 
brushless  dc  motors  at  NWC,  China  Lake  promise  a  more 
complete  and  reliable  performance  data  base  for  future 
modeling  improvements.  The  interactive  nature  of  the 
simulation  program  permits  easy  access  to  motor  and 
controller  parameters  and  facilitates  future  parameter 
modification  to  accommodate  updated  performance 
measurements.  Validation  of  the  computer  simulation  was 
performed  not  only  with  comparison  of  predicted  and 
physically  observed  behavior,  but  also  with  analytical 
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methods.  Lumped  parameter  modeling  and  state  space 
solutions  determined  in  Chapter  VI  were  used  to  accurately 
predict  the  detailed  simulation  results  of  Chapter  VII. 

B.  RECOMMENDATIONS  FOR  FURTHER  STUDY 

All  analyses  performed  in  this  study  were  based  on 
linear  fin  actuator  load  conditions.  Mechanical  linkage 
design  consideration  with  inclusion  of  loading  and  power 
transmission  effects,  such  as  modeled  in  Wright's  thesis 
[Ref. 12],  should  be  investigated  for  torsional  and  stall 
torque  operating  conditions. 

The  numerical  accuracy  of  all  computer  simulations 
conducted  in  this  work  is  limited  by  the  nature  of  small 
step  trapezoidal  integration  and  should  be  considered  as  an 
area  for  future  improvement.  Since  convergence  criteria  is 
constantly  monitored,  modification  to  the  integration 
method  may  be  readily  evaluated  through  observation  of 
numerical  convergence  behavior. 

A  study  of  power  dissipation  and  heat  sinking 
requirements  of  solid  state  components  is  warranted  based 
on  the  high  current  demands  observed  during  simulation  of 
position  control. 

Feasibility  of  electrical  power  regeneration  during 
dynamic  braking  action  of  the  motor  was  suggested  and 
deserves  more  extensive  evaluation  in  future  studies. 
Because  of  the  anticipated  lengthy  duration  of  missile 
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flight  control,  adaption  of  such  an  energy  conservation 
measure  would  reduce  the  demand  on  the  missile  power  supply 
and  conceivably  support  size  and  weight  reduction. 

Improved  modeling  of  diode  response  characteristics 
will  enhance  the  simulation  of  freewheeling  action 
encountered  during  commutation  switching.  Presently, 
diodes  are  modeled  as  either  conducting  or  not  conducting, 
depending  on  bias  conditions.  The  corresponding  diode 
resistance  characteristics,  therefore,  are  discontinuously 
modeled  and  require  artificial  programming  techniques  to 
simulate  their  physical  behavior. 


APPENDIX  A 


BRUSHLESS  DC  MOTOR  SIMULATION  PROGRAM 
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.  .  MAIM  PROGRAM 


I  ROSSITTO,  VS  THESIS  PROF  GERBA  03/26/87  | 

I _ BRUSHLESS_DC_MOTOR _ I 

SYSTEM  REQUIREMENTS 

This  simulation  is  written  for  compilation  using  MS  FORTRAN77  V3.31. 

Three  programs:  BLDCM1.FOR,  BLDCM2.FOR,  &  BLDCM3 . FOR  must  be 

compiled  and  linked.  This  version  uses  PLOTWORKS  PLOT88  for  graphic 

output  support;  the  library  must  be  included  during  linking. 

-  Hardware  Reqmts  — >  INTEL  8088/8086  family  (PC/XT) 

or  INTEL  80286  family  (AT) 

{{  INTEL  8087/80287  math  coprocessor  highly  recommended)} 

-  Memory  Reqmts  — >  6iOK  (RAM  resident  utility  programs  may  have 

to  be  stripped.) 

-  Storage  --»  Hard  Disk  preferred,  Minimum  2  Floppy  Drive  System 

For  use  with  floppy  drives,  virtual  memory  scheme 
requires  360KB  data  disk.  The  selection  of  VM  default 
drive  is  menu  selectable. 

-  DOS  Configuration  — >  CONFIG.SYS  file  must  contain: 

device-ANSI.SYS 

files-15 

-  Support  Files  — >  BLDCM.INP  (formatted  input  data  which  is 

accessible  during  execution  of  program) 

BLDCM1 .  VIR  | 

BLDCM2.VIR  |  These  4  files  are  generated  by 
5LDCM3.VIR  |  the  simulation  program  and  are 
BLDCM4.VIR  |  used  as  virtual  memory. 

PROGRAM  DESCRIPTION 

This  program  simulates  the  detailed  operation  of  a  bipolar, 
three  phase  brushless  dc  motor.  Console  interaction  by  the  user 
provides  the  ability  to  simulate  under  a  broad  range  of  operating 
parameters  as  well  as  initial  conditions.  Since  the  simulation 
is  intended  to  be  used  primarily  for  design  purposes,  repetitive 
iterations  with  saved  data  are  possible. 

The  method  of  simulation  used  in  this  program  emulates 
processing  through  the  use  of  two  nested  systems  of  non-1 inear 
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C  differential,  equations.  The  inner  loop  serves  to  describe  the 
C  electrical  system  response,  while  the  outer  loop  describes  the 

C  electro-mecanical  system  response.  Both  systems  of  non-linear 

C  differential  equations  are  solved  using  Newton-like  iterative 
C  convergence  schemes.  The  inner  loop  is  numerically  stiff  in  that 

C  the  non-linear  nature  of  the  diode  equivalent  resistance  allows 

C  numerical  convergence  to  two  solutions  when  the  diode  cutoff 

C  threshold  is  approached.  This  is  dealt  with  by  using  a  fixed, 

C  but  relatively  small  step  size  and  a  cautious  modified  Newton’s 
C  method  of  solution. 

C  Trapezoidal  integration  is  used  for  computational  speed. 

C  Comparison  to  results  attained  using  Runge-Kutta  methods  on  IBM- 
C  370  based  CSMF  indicate  good  accuracy.  The  first  order 

C  differential  equation  solver,  TCONST,  is  an  algebraic  solver  and 

C  provides  a  rapid  means  of  solving  an  otherwise  iterative  problem. 
C 

C  Variable  Descriptors  are  explained  throughout  the  program  and, 

C  therefore,  will  not  be  described  here. 

C 

IMPLICIT  REAL**.  (A-2) 

COMON  BEGTIM ,  FINTIM ,  NPTS  ,  IOPORT  ,  MODEL  ,  XLEN ,  YLEN ,  PLEN ,  PLEN1 , 

+  XTITLE , YTITLE , PTITLE, PTIT1 

REAL**.  XTIMEC 1010 ) 

INTEGER* 2  NTIME ,  NTERMS  ,  IOPORT ,  MODEL ,  NUMIT ,  NUMIN ,  XLEN ,  YLEN ,  N , 

+  NTIM1 . NTIM11 , NTIM12 , NTIM13 , NTIM14 , 

+  NTIM21 ,  NTIM22 ,  NTIM23 ,  NTIM32 ,  NTIM33  ,  NTIM34  ,  NTIM3  5 , 

+  ELEMNT ,  SIM2PL .  POSIT,  DIR, 

+  NTIM01 ,  NTIM02 ,  NTIM03  ,  NTIM04  .  NTIM05 ,  NTIM06 ,  HALF , 

+  NTIM4  7 ,  NTIM43 ,  FMODEL ,  NOTH ,  NPTS ,  AHALF ,  BHALF ,  CHALF , 

+  TRIG1 , TRIG2 , TRIG3 , TRIG4 , TRIG5 , TRIG6 , DIRM1 , PLUG 

logical*2  TOGGLE 
charaeter*3  DISOPT, DRIVE, DRIVE1 

char acter*6  ANS 1 , ANS 1 1 , ANS21, ANS27 , PRTSEL , NONLIN , TYPE , TYPE1 
charactar*25  XTITLE , YTITLE , NLCHAR 
character*51  PRTCHR, PTITLE , PTIT1 
C 

C  ...  Introductory  Page  (1  time  good  deal!) 
call  CLRSCR 
write(*,'  ' 

PAUSE 

C 

C  ***  Open/Read/Close  input  data  file  *** 

13  open(2 , FILE”’ BLDCM. INF’ , STATUS- ’ OLD ’ , ACCESS-’ SEQUENTIAL ’ ) 
read< 2 , 1000 )  PMODEL , PRTCHR , RIN , ROUT , RDADJ 
read(2 , 1020 )  BEGTIM , FINTIM , PTSPLT .MAXITS , SIM2PL 
read(2, 1022)  KPWM , KV, E0 , EDOTO , TTIME ,XORG, YORG 
read(2 , 1024 )  RS . RSAT , JL , BL , KTM 
read(2 , 1026 )  JM, RA , LA , KBM, THADV, TDPLUG 
read ( 2 , 1028 )  BM, KP , PERIOD , DBAND ,KA 
read(2, 1030)  TYPE , RCUT , STPMAG , RSLOPE 
read (2, 1032)  SINAMP , SINFRQ , SINPHA, DRIVE 
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close (2, STATUS-' KEEP'  ) 


C 

C 

C 

C  ***  DISPLAY  MAIN  MENU  SELECTIONS  *** 

C  .*•****.*****.**•***•*.*••*.***.**•* 

C 

1  call  CLRSCR 

call  GOTOXY (8,1) 
write C* , 5) 
read( * . ’ (A) 1 )  ANSI 
C  ...  Hardware  Options  . . . 

if  ((ANSI  .eq.  'h' )  .or.  (ANSI  ,eq.  ’H’))  then 
C 

101  call  CLRSCR 

call  GOTOXY (17,24) 

write(*. *)'**♦  CURRENT  PRINTER  SELECTION  ***’ 
call  GOTOXY (20,20) 
write(*,*)  FRTCHR 
call  GOTOXY (10.1) 
write(* , 105) 
read(*, • (A)' )  ANS11 
C 

C  ...  Printer  Options  . . . 

if  ((ANS11  .eq.  ’p')  .or.  (ANS11  eq.  ’P'))  then 
call  PRNOPT ( MODEL , PRTSEL , PRTCHR) 
go  to  101 
C 

C  ...  Quit  the  Hardware  Menu  .  . . 

elseif ( (ANS11  .eq.  ’q' )  .or.  (ANS11  .eq.  'Q'))  then 
go  to  1 

else 

go  to  101 
end  if 
C 

C  ...  Motor  Parameters  . . 

elseif  ((ANSI  .eq.  'm' )  .or.  (ANSI  .eq.  'M’))  then 
C 


call  MOTFAR(KTM ,  KBM, RIN.ROUT  ,  RDADJ  ,  RA ,  LA,  BM,  BL .  JM,  TL, 
+  RSAT ,RCUT .TTIME , RS , THADV, IDPLUG) 

go  to  1 

. . .  NON-LINEAR  ELEMENT  SELECTION  MENU  . . . 

elseif  ((ANSI  ,eq.  'n' )  .or.  (ANSI  .eq.  ’ N ’ ) )  then 
14  call  CLRSCR 

call  GOTOXY (21, 1 ) 
write(* , 272 )  NLCHAR 
call  GOTOXY (1,1) 
write(* , 270 )  KV.KP 
read(*. ' (A) ' )  ANS27 
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C  ...  RELAY  AS  NON-LINEAR  ELEMENT  . . . 


if  ( (ANS27  . eq .  ’r')  .or.  (ANS27  .eq.  ’R’))  then 
ELEMNT-1 
NLCRAR- 1  RELAY ' 
call  CLRSCR 
NONLIN-’R’ 
write! * , 290 )  DBAND 
read( * , ' (A) • )  ANS21 


if  (ANS21  .aq.  'DBAND')  then 
call  GOTOXY (24.1) 

write! *. 1 CA\ )')' Enter  a  REAL  value  for  DBAND-->  1 
read!*,*)  DBAND 
go  to  291 

elaeif  ! (ANS21  . eq .  'q')  .or.  (ANS21  .eq.  'Q'))  then 
go  to  1* 


go  to  291 
end  If 

PULSE  WIDTH  MODULATOR  AS  NON-LINEAR  ELEMENT  .  .  . 

elaeif  ( ( ANS27  eq.  'p')  or.  ( ANS27  .eq.  ‘P’))  then 
ELEMNT-3 

NLCHAR-' PULSE  WIDTH  MODULATOR’ 

call  CLRSCR 

NONLIN-’P' 

write!*, 300)  DBAND , PERIOD , KPWM 
read!*, ■ (A)' )  ANS21 

if  !ANS21  . eq.  'DBAND')  then 
call  GOTOXY! 2* , 1 ) 

write!* ,' !A\ )')’ Enter  a  REAL  value  for  DBAND-->  ’ 
read!*,*)  DBAND 
go  to  301 

elaeif  !ANS21  .eq.  ’PERIOD’)  then 
call  GOTOXY (24,1) 

write!*, ’ (A\)' ) 'Enter  a  REAL  value  for  PERIOD--*  ’ 
read!*.*)  PERIOD 
go  to  301 

elaeif  ( ANS21  .eq.  'KPWM’)  then 
call  GOTOXY (24,1) 

write!*. ’ (A\ )’) ’Enter  a  REAL  value  for  KPWM-->  ’ 
read!*,*)  KPWM 
go  to  301 

elaeif  !(ANS21  .eq.  ’q’)  .or.  (ANS21  .eq.  ’ Q’ ) )  then 
go  to  14 


go  to  301 


elaeif  (CANS27  .eq.  *KV’ )  .or.  !ANS27  ,eq.  ’kv'))  then 
call  GOTOXY (24,1) 


write(* ,' (A\ )')' Enter  a  REAL  value  for  KV-->  ' 
read(*,»)  KV 
go  to  14 

elself  ( (ANS27  .eq.  'KP')  .or.  (ANS27  .  eq.  'kp'))  then 
call  GOTOXY(24 . 1 ) 

write(* , ' (A\ ) ' ) ’Enter  a  REAL  value  for  KP-->  ’ 
raad( *, *)  KP 
go  to  14 

elseif  ( (ANS27  .eq.  'q')  .or.  (ANS27  ,eq.  'Q'))  then 
go  to  1 

else 

go  to  14 
end  if 

Z  ...  Simulation  Options  . . . 

elseif  ((ANSI  .eq.  'o’)  .or.  (ANSI  .eq.  '0'))  then 

202  call  CLRSCR 

DELTIM-(FINTIM-BEGTIM)/(PTSPLT*SIM2PL) 

if  (FINTIM/DELTIM  ,gt.  MAXITS)  DELTIM  -FINTIM/MAXITS 

NTERMS-IFIX(FINTIM/DELTIM)+1 

write(* , 240 )  BEGTIM, FINTIM. PTSPLT , MAXITS . SIM2PL , EO , EDOTO , 

+  XORG.YORG,  DRIVE,  DELTIM,  NTERMS 

read(», ’ (A) ' >  ANS21 

if  (ANS21  eq.  'BEGTIM')  then 
call  GOTOXY(24 , 1 ) 

write(«, ’ (A\ )') 'Enter  a  REAL  value  for  BEGTIM-->  ' 
read ( * , * )  BEGTIM 
go  to  202 

elseif  (ANS21  .eq.  'FINTIM')  then 
call  GOTOXY(24 , 1 ) 

write(*.’(A\)') 'Enter  a  REAL  value  for  FINTIM--»  ’ 
read( *, * )  FTIME 
if  (FTIME  .le.  BEGTIM)  then 
call  CLRSCR 
call  GOTOXY (10,10) 

write(* , *)  'INVALID  FINTIM  ...  FINTIM  must  be  >  BEGTIM' 
go  to  202 


FINTIM-FTIME 
go  to  202 

elseif  ( ANS21  .  eq.  'PTSPLT’)  then 
call  GOTOXY ( 24 ,1) 

**rite(*.  ’  (A\ ) ' ) '  Enter  a  REAL  value  for  PTSPLT--> 
read(*, *)  PTSPLT 
go  to  202 
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elseif  (ANS21  .eq.  'MAXITS')  then 
cell  GOTOXY(24,1) 

write(* , 1 (A\ )')’ Enter  a  REAL  value  for  MAXITS-->  ' 
read ( * , * )  MAXITS 
go  to  202 

elseif  (ANS21  .eq.  'SIM2PL')  then 
call  GOTOXY (24 , 1 ) 

write(*, ' <A\)' ) 'Enter  a  INTEGER  value  for  SIM2PL— >  ' 
read( * , * )  SIM2PL 
go  to  202 

elseif  ( ANS21  .eq.  'E0')  then 
call  GOTOXY(24.1) 

write(* , 1 (A\ )') ‘ Enter  a  REAL  value  for  E0  (degrees) — >  ' 
read(* , * )  E0 
go  to  202 

elseif  (ANS21  . eq .  'EDOTO')  then 
call  GOTOXY (24 ( 1) 

write(* , * (A\ )')’ Enter  a  REAL  value  for  EDOTO  (deg/sec)--> 
read(*,»)  EDOTO 
go  to  202 

elseif  (ANS21  .eq.  ’XORG’ )  then 
call  GOTOXY (24 , 1) 

v*rite(»,  *  (A\)' )  'Enter  a  REAL  value  for  XORG--»  ' 
read(* , * )  XORG 
go  to  202 

elseif  (ANS21  .eq.  ’YORG')  then 


call  GOTOXY (24 , 1) 

write(*,'(A\)')  ’Enter  a  REAL  value  for  YORG— >  ' 
read(*, *)  YORG 
go  to  202 

elseif  (ANS21  .eq.  'DRIVE')  then 
call  GOTOXY  (24 , 1) 

write(*, ’ (A\ )’) 'Enter  Drive  (A,B,C)  for  data  storage  — » 
read(*. • (A)' )  DRIVE1 

if  ( < DRIVE 1  .eq.  'A')  .or.  (DRIVE1  .eq.  ’a'))  then 
DRIVE- 'A' 

elseif  ( ( DRIVE 1  .eq.  ’B')  .or.  (DRIVEl  .eq.  ’ b ' ) )  then 
DRIVE-' B* 

elseif  ((DRIVEl  .eq.  ’ C ’ )  .or.  (DRIVEl  .eq.  'c'))  then 
DRIVE-'C' 

else 

call  CLRSCR 
call  GOTOXY (10, 20) 

write(*,*)  'Invalid  Drive  Specified  -  Enter  A,  B,or  C’ 
PAUSE 
end  if 
go  to  202 

Quit  Simulation  Options  Menu  . . . 
elseif  (ANS21  .eq,  'Q' )  then 
go  to  1 
else 
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go  to  202 


.  Coranand  Input  Selection  . . . 

elseif  ((ANSI  .eq.  ' c 1 )  .or.  (ANSI  .eq.  ’C’))  then 
cell  CLRSCR 

write( * . 2*5 )  TYPE , STPMAG , RSLOPE , SINAMP,  SINFRQ , SINPHA 
read( * , ‘ (A) ' )  ANS21 

if  (ANS21  .eq.  ’TYPE')  then 
caU  GOTOXY(2* ,  1) 

write(* , 1 (A\ ) ' ) ' Enter  a  STEP,  RAMP,  or  SINE--*  ’ 
read(*. ' (A) ‘ )  TYPE1 

if  ( (TYPE1  .ne.  'STEP')  .and.  (TYPE1  ,ne.  'RAMP')  .and. 

*■  (TYPE1  .ne.  'SINE'))  then 

call  CLRSCR 
call  GOTOXYdO,  10) 
write(*,*)  ’Invalid  Selection  !!!’ 
call  GOT0XY(20,l) 


go  to  203 


TYPE-TYPE 1 


go  to  203 

elseif  (ANS21  .eq.  ’STEMAG’)  then 
call  GOTOXY ( 2* , 1 ) 

wrlte(*,’(A\)’) ’Enter  a  REAL  value  for  STPMAG--* 
read!*,*)  STEWAG 
go  to  203 

elseif  (ANS21  .eq.  'RSLOPE’)  then 
call  GOTOXY ( 2* , 1) 

write(*, ’ (A\ )’) 'Enter  a  REAL  value  for  RSLOPE — > 
read(*. *)  RSLOPE 
go  to  203 

elseif  (ANS21  .eq.  ’SINAMP’)  then 
call  GOTOXY ( 2* , 1 ) 

write(* ,’ (A\ )’>’ Enter  a  REAL  value  for  SINAMP--* 
read(* , * )  SINAMP 
go  to  203 

elseif  (ANS21  .eq.  ’ SINFRQ’ )  then 
call  GOTOXY (2* , 1 ) 

write(* (A\ )’)’ Enter  a  REAL  value  for  SINFRQ--* 
read(* , * )  SINFRQ 
go  to  203 

elseif  (ANS21  .eq.  ’SINPHA')  then 
call  GOTOXY ( 2 * , 1 ) 

write(*, ' (A\ )’) 'Enter  a  REAL  value  for  SINPHA--* 


read(* , * )  SINPHA 
go  to  203 

C  ...  Quit  Simulation  Options  Menu  . . . 

elseif  (ANS21  . eq.  ' Q ' )  then 
go  to  1 

else 

go  to  203 
end  if 

C  ...  Save  Options  to  File  . . . 

elseif  ((ANSI  .eq.  's')  .or.  (ANSI  .eq.  '  S ’ ) )  then 

C 

C  **..*.**••**•..*.*.**•*••*.**.**«***»*.» 

C  ***  OPEN/WRITE/CLOSE  INPUT  DATA  FILE  *** 

C 

C 

open( 2 , FILE" ' BLDCM . INP' .STATUS- 'OLD' .ACCESS-' SEQUENTIAL' ) 
write(2 , 1000 )  PMODEL , PRTCHR , RIN , ROUT , RDADJ 
wri te( 2 , 1020 )  BEGTIM , FINTIM, PTSPLT , MAXITS , SIM2PL 
write(2, 1022)  KPWM.KV, EO , EDOTO , TTIME ,XORG, YORG 
write(2, 1024)  RS , RSAT , JL , BL , KTM 
write(2, 1026)  JM.RA.LA.KBM, THADV , TDPLUG 
write(2, 1023)  BM.KP , PERIOD , DBAND ,KA 
write(2, 1030)  TYPE , RCUT , STPMAG , RSLOPE 
write (2 , 1032 )  SINAMP , SINFRQ , SINPHA , DRIVE 
c los e ( 2 , STATUS- ' KEEP  * ) 

C 

go  to  1 

C 

C  ...  Run  the  Program  . . . 

elseif  ((ANSI  .eq.  'r')  .or.  (ANSI  .eq.  'R’))  then 
go  to  2 

C 

C  ...  Quit  the  Program  . . . 

elseif  ((ANSI  ,eq.  ’q’)  .or.  (ANSI  eq.  'Q'))  then 
stop 

else 

go  to  1 
endif 

C 

C  ...  Open  an  output  data  file 
2  continue 

if  (DRIVE  .eq.  'A')  then 

OPEN ( 4 , FILE- ’ a : BLDCM1 . VIR ’ .STATUS- 'NEW' ) 

OPEN ( 5 , FILE- ’ a : BLDCM2 . VIR ’ , STATUS- ’ NEW ’ ) 

OPEN ( 6 , FILE- ' a : BLDCM3 . VIR ' , STATUS- ' NEW ’ ) 

OPEN ( 7 , FILE-' a : BLDCM4 , VIR' , STATUS- ' NEW' ) 
elseif  (DRIVE  .eq.  '8')  then 

OPEN(4 , FILE-' b : 8LDCM1 . VIR’ , STATUS-' NEW’ ) 

OPEN ( 5 , FILE-' b : BLDCM2 . VIR' ,STATUS-'NEW' ) 

OPEN ( 6 , FILE- ' b : BLDCM3 . VIR ’ , STATUS- ' NEW ’ ) 

OPEN ( 7  ,  FILE- '  b  :  BLDCM4  .  VIR '  ,  STATUS- ’  NEW  ’  ) 


185 


>.v,v.v.v 


,V.V  "■  v-'.i  '.V  aV.V.'aI  ,  YV.N  V» Vs  . V.V'LV JV   -  ^ 


•lsaif  (DRIVE  aq.  'C')  than 

OPEN ( 4 , FILE- ' c : BLDCM1 . VIR’ , STATUS- ' 
OPEN ( 5 . FILE- ' c : BLDCM2 . VIR ’ , STATUS- ' 
OPEN ( 6 , FILE- ' c : BLDCM3 . VIR ’ , STATUS- ' 
OPEN ( 7 , FILE- ' c : BLDCM4 . VIR ' , STATUS- ' 
endif 
C 

C  ***  Listing  of  constants  *»* 

C 

PI  -  3. 14159265 
KADJ-0.63 
KK3  -  3.590 
TN2-.1 
N-30.0 
TCIMC-0 . 01 
TLL-0 . 0 
VSAT- .  4 
REVTIM— 0 . 1 
VN1-0. 

VN2-0. 

VSGREF-30 . 

KINT-10000. 

KRAMP-18000  . 

VSG-0. 

VINHF1-75 . 0 
REDRAT-. 1 
C 

C  Initial  Conditions 
TRIG1-0 
TRIG2-0 
TRIG3-0 
TRIG4-0 
TRIG5-0 
TRIG6-0 
WM-0. 

THETA-0 . 

PTHETA-0 . 0 
THETA1-0 . 

IMA-0 . 0 
IMB-0 . 0 
IMC-0 . 0 
IMAB-0 . 0 
IMBC-0 . Q 
IMCA-0 . 0 
NCTR-0 
NPTS-0 
NTIM1-0 
NTIM01-0 
NTIM02-0 
NTIM03-0 
NTIM04-0 
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NTIM06-0 


NTIM12-0 


NTIM14-0 


NTIM03-0 


NTIM05-0 


NTIM35-0 

ICQ1-.75 

ICQ2-.75 

ICQ3-.75 

ICQ4-.75 

ICQ5-.75 

ICQ6-.75 

ICIMAB-0  . 

ICIMBC-0 . 

ICIMCA-0 . 

ICTMF-0 . 


TSTART-0 . 0 
TOGGLE- . tru* . 


CURV5-0 . 
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YD2-0. 

YD3-0. 

YDi-O. 

TODM12-0 . 

YDDM13-0. 

TODM14-0. 

YDD2-0 . 

YD03-0 . 

TDDi-O. 

PREV7-0. 

CURV7-0 . 

HOLD3-0 . 

PLUG-0 
TFPLUG— 0 . 

DIRM1-0 

C 

C  RELATIONSHIPS 
KT-KTM*KADJ 
KB-KBM*KADJ 
BLP-BL/(N**2) 

JLP-JL/ (N**2) 

J-JM+JLP 

B-BM+BLP 

AI-LA/RA 

A2-J/B 

A3 -LA  /  (RA+RSAT) 

RS1-RS/2. 

RS2-RS/2. 

VXNIC— 15 . O/KINT 
VINHAF-VINHF1 

C  ...  Initial  conditions  for  THETA( fin .degrees)  and  Omega C fin , degrees ) 
E0RAD-E0*PI/  (180  .  *REDRAT) 

EDOTOR-EDOTO*PI/ < 180 . *REDRAT) 
if  (KP  . ne .  0. )  then 
WHO— EDOTOR/KP 
THETAO— EORAD/KP 
•lseif  (KP  .eq.  0.)  then 
WHO— EDOTOR 
THETAO— EORAD 
end  if 
WW-WMO 
X3-THETA0 


Output  Simulation  Options  to  Output  Data  File 


C  *****  Time  Generator  . . .  0-50ms  ***** 
c  ****.*.*.*..»**.**««*.......»»**,.... 


DELTIM-(FINTIM-BEGTIM) / (PTSPLT*SIM2PL) 

if  (FINTIM/DELTIM  ,gt  MAXITS)  DELTIM  -FINTIM/MAXITS 

NTEPMS-IFIX(FINTIM/DELTIM)+1 


SPACE-DELTIM/2. 


C  ***  Clear  Screen  &  Home  Cursor  *** 
call  CLRSCR 
call  GOTOXY (10,29) 

write!*,*)  'Elapsed  Simulation  Time' 
call  GOTOXY (12,41) 
write!*,*)  'seconds' 
call  GOTOXY (15,1) 

write(*, 15)  BEGTIM , FINTIM, DELTIM , NTERMS 
15  format(22X, ’ Simulation  Start  Time  -->  ’,F8.7,/, 

+  23X Simulation  Stop  Time  - >  ',F8.7,/, 

+  23X , ' Simulation  Step  Size  - >  ',F8.7,/, 

+  23X, 'Total  Number  of  Steps  — >  *,I4) 

call  GOTOXY (21,1) 

C 

if  (CNONLIN  .eq.  'r')  .or.  (NONLIN  .eq.  'R'))  then 


write ( * .  * ) 


***  NON-LINEAR  ELEMENT  IS  RELAY 


slseif  ((NONLIN  . eq .  'p')  .or.  (NONLIN  .eq.  ’P'))  then 
write!*,*)  •  ***  NON-LINEAR  ELEMENT  IS  PWM 


write!*,*) 


go  to  1 


NON-LINEAR  ELEMENT  NOT  SELECTED  ***' 
. . .  Return  to  Main  Menu  . . . ’ 


DO  100  NTIME  -  1, NTERMS 
TIME  -  ( NTIME- 1)*DELTIM 

***  Output  Elapsed  Simulation  Time  to  Display  *** 

call  GOTOXY (12,33) 
write(* , 93 )  TIME 
93  format (F7 . 6 ) 

.  .  .  Coomand  Input  Signal  Generator  .  .  . 
if  (TYPE  .eq.  ’STEP')  then 
ORDER-STFMAG 

elseif  (TYPE  .eq.  'RAMP’)  then 
ORDER-RSLOPE*TIME 
elseif  (TYPE  .eq.  'SINE')  then 

ORDER-SINAMP*s in ( SINFRQ*TIME+SINPHA ) 


VSGD  EL-  ( VSGREF  -  VSG )  /  2  . 


call  DEADSP(P1 . P2 , VSGDEL , VSGERR) 

call  INTGRLtNTIME , NTIM21 , DELTIM, VINIC , PREV5 , VSGERR , 
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CUHV5 , H0LD1 , VININT ) 
VINHFG-KINT*VININT 


INITIAL  ITERATIVE  CONDITIONS 


if  (NTIME  .  eq.  2)  then 
WM-WM+ ( ORDER-X3 ) *  1 . E - 3 
X3-X3+(ORDER-X3)*l.E-3 
ZA3-1.E-6 
ZB3—  l.E-4 
ZC3-1.E-4 


ITERATIVE  LOOP 


do  500  NUMIT-1,20 


***  Phase  angles  *** 

BEMFA-(3.0»SIN(2.0*THETA+(11.0*PI/6.0) )+ . 590*SIN(10 . 0 

*  THETA+(1.0*PI/6.0))) 

BEMFB-C  3 . 0*SIN<  2 . 0*THETA+( 7 . 0*PI/6 . 0 ) )  + . 590*SIN( 10 . 0* 

♦  THETA+(5.0*PI/6.0))> 

BEMFC- ( 3 . 0*SIN ( 2 . 0*THETA+( 3 . 0*PI /6 . 0 ) )  + . 590*SIN  C 10 . 0* 
+  THETA+(9.0*PI/6.0)>) 

***  Normalize  leg  EMF  *** 

VEMFA  -  BEMFA  »  KB/KK3  *  WM 
VEMFB  -  BEMFB  *  KB/KK3  *  WM 
VEMFC  -  BEMFC  *  KB/KK3  *  WM 
VEMFAC  -  VEMFA  -  VEMFC 
VEMFBA  -  VEMFB  -  VEMFA 
VEMFCB  -  VEMFC  -  VEMFB 

call  C0MADV( THETA, PI , float ( DIR) *THADV , THCON , THRST) 
call  HALL ( THCON, SE1.SE2.SE3) 


THETAF”REDRAT*THETA* 180 . /PI 
0MEGAF-R£DRAT*WM*180 . /PI 
FOSERR-ORDER-K?*THETAF -KV*CMEGAF 


.  Utilization  of  Non-Linear  Element  . . . 

.  PULSE  WIDTH  MODULATOR  . , 

if  ((NONLIN  .eq.  'p')  .or.  (NONLIN  .eq.  ’P'))  then 
call  PV*CD ( TIME  ,  NUMIT ,  TSTART  .  PERIOD ,  TOGGLE ,  POSERR , 

*■  DBAND.VIF.VIB, DIR,  VREF, THRESH, KPWM) 

.  IDEAL  RELAY  , . . 

elseif  ((NONLIN  .eq.  >r')  .or.  (NONLIN  eq.  ’R')>  then 
call  R£LAY(POSERR,DBAND,VIF,VIB,DIR) 


***  NON-LINEAR  ELEMENT  NOT  SELECTED 


call  GOTOXYC21, 1) 
wnte(*,*)  ' 

write(*,*)  '  ...  Return  to  Main  Menu 

PAUSE 
go  to  1 
end  if 

VIN-VIF-VIB 

IL-VIN/(2.0*RCUT) 


INITIAL  ITERATIVE  CONDITIONS  FOR  INNER  ITERATION  ***** 


TRIG1  -  Q 
TRIG2  -  0 
TRIG3  -  0 
TRIG!  -  0 
TRIG5  -  0 
TRIG6  -  0 

if  ((TIME  .ge.  TFPLUG)  .or.  (TIME  .eq.  TOPLUG))  then 
if  ( f loat (DIRM1 )*f loat(DIR)  .It.  0.)  then 
TO PLUG-TIME 
TFPLUG-TOPLUG+TDPLUG 
PLUG-1 
else 

TOPLUG-O . 

TFPLUG— 0 . 

PLUG-0 
end  if 
end  if 

call  TRANSW(TIME  .REVTIM ,  BEMFA,  BEMFB  ,  BEMFC ,  BEMFT  ,  VEMFA , 

+  VEMFB  ,  VEMFC ,  VIB ,  VIF ,  IM ,  IMA .  IMB ,  IMC ,  VN1 ,  VN2  ,  SW1 , 

+  SW2 ,  SW3  ,  SWA  ,  SW5 ,  SW6 ,  THCON .  THCON1 ,  RSAT ,  POSIT  ,  DIR , 

+  VD1D , VD2D , VD3D , VD4D , VD5D , VD6D , RIN , ROUT , RS , 

+  REQA1 , REQA2 , REQB 1 , REQB2 , REQC1 , REQC2 , IAB , IBC , ICA , 

+  PVAO ,  PVBO ,  PVCO ,  NODE ,  TRIG1 ,  TRIG2 ,  TRIG3  ,  TRIG4  , 

+  TRIG5 , TRIGS , RA , PLUG , VAIND , VBIND , VCIND ) 

call  TCONST ( ICQ1 . . 75-SW1 , TTIME , NTIME , NTIMO 1 , DELTIM, Q1EXF ) 
call  TCONST (ICQ2, . 75-SW2, TTIME , NTIME , NTIM02 , DELTIM, Q2EXP ) 
call  TCONST ( ICQ3 , . 75-SW3 , TTIME , NTIME , NTIM03 , DELTIM, Q3EXP ) 
call  TCONST ( ICQ4 , . 75-SW4 , TTIME .NTIME , NTIM04 , DELTIM , QAEXP ) 
call  TCONST ( ICQ5 . . 75-SW5 , TTIME , NTIME , NTIM05 , DELTIM , Q5EXP) 
call  TCONST ( ICQ6 , . 75-SW6 , TTIME , NTIME , NTIM06 , DELTIM, Q6EXP) 

call  LIMIT (RSAT, ROUT  2 . 0*RCUT*01EXP, RQ1 ) 
call  LIMIT (RSAT . RCUT , 2 . 0*RCUT*Q2EXP , RQ2 ) 
call  LIMI i (RSAT . RCUT , 2 . 0*RCUT‘Q3EXP , RQ3 ) 
call  LIMIT (RSAT , RCUT , 2  0*RCUT*0AEXP , RQA ) 
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UNCLASSIFIED 


F/G  18/2 


NL 


c  «U  LIMIT  (RSAT ,  RCUT ,  2 . 0*RCUT*Q5EXP ,  RQ5 ) 
call  LIMIT (RSAT , RCUT , 2 . 0*RCUT»Q6EXP , RQ6 ) 


R£QA1-RQ1*RD1/ (RQ1+RD1 ) 
REQA2-RQ2*RD2 / ( RQ2+RD2 ) 
REQB 1-RQ3*RD3 / (RQ3+RD3 ) 
REQB2-RQ4*RD4/(RQ4+RD4) 
REQC1“RQ5*RD5/ (RQ5+RD3 ) 
REQC2«RQ6*RD6/(RQ6+RD6 ) 

ASIGN-ZA3 

BSIGN-ZB3 

CSIGN-ZC3 


AHALF-0 

BHALP-0 

CHALF-0 


START  INNER  LOOP 


do  650  NUMIN-1,20 
IMA-ZA3 
IMBmZB3 
IMC-ZC3 

CALL  DERIV(DELTIM , KTIME, HTIM12 .0.0, PREV2 . IMA , YY2 . YDM12 , YD2 , 
+  YD DM12 , YDD2 . DIADT ) 

CALL  DERIV(DELTIM . NTIME , NTIM13 ,0.0, PREV3 , IMB , YY3 , YDM13 , YD3 , 
+  YDDM13 , YDD3 , DIBDT ) 

CALL  DERIV(DELTIM,NTIME,NTIM14,0.0,PREV4,IMC,YY4,YDM14,YD4, 
+  YDDM14 , YDD4 , DICDT ) 

VAIND-LA»DIADT 

VBIND-LA*DIBDT 

VCIHD-LA*DICDT 

PVAO“IMA* ( RA+RIN / 2 . )+VAIND 
PVBO-IMB*(RA+RIN/2.  J+VLIND 
PVCO-IMC*(RA+RIN/2. )+VCIND 

VAOPVAO+VEMFA 

VBO-PVBO+VEMFB 

VCO-PVCO+VEMFC 

call  TRAHSW (TIME , REVTIM , BOCA , BEMFB ,  BEMFC , BEMFT , VQ1FA , 

+  VEMFB , VEMFC, VIB , VIF , IM, IMA, IMB , IMC , VN1, VN2 , SW1 , 

+  SW2 , SW3 , SW4 , SW5 , SW6 , THCOH , THCON1 , RSAT , POS IT , DIR , 

+  VD1D , VD2D , VD3D, VD4D , VD5D , VD6D ,RIN .ROUT ,RS , 

♦  REQA1 , REQA2 , REQB 1 , REQB2 , REQC 1 , REQC2 , IAB , IBC , ICA . 

+  PVAO , PVBO , PVCO , NODE , TRIG1 , TRIG2 , TRIG3 . TRIG4 , 


192 


ty. 


TRIG5 , TRIG6 , RA , PLUG, VAIND , VBIHD , VCIND ) 


call  LIMIT C- 
caU  LIMITt- 
caH  LIMIT <- 
call  LIMIT (- 
call  LIMIT (- 
call  LIMIT <- 


. 7 , 800 . 0 , VD1D , VOID) 
.7,800. 0 , VD20 , VD2D) 
.  7 , 800 . 0 , VD3D, VD3D) 
.  7 , 800 . 0 , VD*D , VD4D) 
.  7 , 800 . 0 , VD5D , VD5D) 
.7,800.0, VD6D , VD6D) 


call  FCNSW(VD1D+, 6 , RSAT , RSAT , RCUT , RDX 1 ) 
call  FCNSW( VD2D+ . S , RSAT , RSAT , RCUT , RDX2 ) 
call  FCNSW( VU3D+ . 6 , RSAT , RSAT , RCUT , RDX3 ) 
call  FCNSW<VD*D+. 6, RSAT, RSAT, RCUT, RDX4) 
call  FCNSW(VD5D+. 6, RSAT, RSAT, RCUT, RDX5) 
call  FCNSW( VD6D+ . 6 , RSAT , RSAT , RCUT , RDX6 ) 


RD1“RDX1+RDADJ 

RD2-RDX2+RDADJ 

RD3-RDX3+RDADJ 

RD4-RDX4+RDADJ 

RD5-RDX5+RDADJ 

RD6-RDX6+RDADJ 


-RQ1*RD1/ (RQ1+RD1) 
-RQ2+RD2/ (RQ2+RD2 ) 
-RQ3+RD3/ (RQ3+RD3 ) 
-RQ4*RD4/(RQ4+RD4) 
HRQ5+RD5/ (RQ5+RD3) 
-RQ6*RD6/(RQ6+RD6) 


J\ 


REQAS 1“REQA 1+RS 1+ROUT / 2 . 
REQAS2-REQA2+RS2+ROUT  72 . 
REQBS 1-REQB 1+RS 1+ROUT / 2 . 
REQBS2-REQB2+RS2+ROUT/2 . 
REQCS 1-REQC 1+RS 1+ROUT / 2 . 
REQCS2-REQC2+RS2+ROUT / 2 . 


VAHTH-VH1+RZQAS2  /( REQAS 1+REQAS2 )  +VH2*REQAS 1  /( REQAS  1+REQAS2 ) 
VBKTH-VH 1 +REQBS2 / ( REQBS 1+REQBS2 ) +VN2+REQBS1 / ( REQBS 1+REQBS2 ) 
VCNTB-VH1+RSQCS2  /  (REQCS 1+REQCS2 )  +VN2*REQCS  1  /  (REQCS  1+REQCS2 ) 

REQA“REQAS1*R£QAS2/ (REQAS1+REQAS2) 

REQB-REQBS 1 *REQBS2 / ( REQBS 1+REQBS2 ) 

REQC-REQCS 1+REQCS2 / ( REQCS 1+REQCS2 ) 

REQAB-2 .O+RA+1 . O+RIN+REQA+REQB 
REQBC-2 . 0+RA+1 . O+RIN+REQB+REQC 
REQCA-2 . O+RA+1 . O+RIN+REQC+REQA 

IAB-(VARTH-VBHTH) /REQAB 
IBC- ( VBHTH-VCNTH > /REQBC 


ICA-(VCNTH-VANTH) /REQCA 


S 


I..I 


c 

ABTAU-2 . 0*LA/REQAB 
BCTAU-2 . 0*LA/REQBC 
CATAU-2 . 0*LA/REQCA 
C 

C  ***  DISCHARGE  OF  PHASE  CURRENTS  ( FREEWHEEL I NG  DIODES)  *** 
if  (PLUG  . aq.  1)  than 
IAfl-0. 

IBC-0. 

ICA-0. 

alaaif  ((POSIT  .aq.  1)  or.  (POSIT  .aq.  4))  than 
IAB-0. 

ICA-0. 

alsaif  ((POSIT  .aq.  2)  .or.  (POSIT  .eq.  5))  than 
IBC-0. 

ICA-0. 

alsaif  ((POSIT  .aq.  3)  .or.  (POSIT  .aq.  6))  than 
IAB-0. 

IBC-0. 

andif 

C 

call  TCONST ( ICIMAB , TAB . ABTAU , NTIME , NTIM32 , DELTIM , IMAB ) 
call  TCONST ( ICIMBC , IBC , BCTAU , NTIME , NTIM33 , DELTIM , IMBC ) 
call  TCONST ( ICIMCA , ICA. CATAU , NTIME , NT IMS* , DELTIM , IMCA) 
C 

FA3-IMAB-IMCA-ZA3 

FB3-IMBC-IMAB-ZB3 

FC3-IMCA-IMBC-ZC3 

C 

IMA- IMAB- IMCA 
IMB— IMBC-IMAB 
IMC- IMCA- IMBC 
C 

IM-  ( aba ( IMA) +aba ( IMB )+abs ( IMC ) ) / 2 . 

C 

C  ***************************************** 

C  *****  MODIFIED  LINEAR  INTERPOLATION  ***** 

c  a**************************************** 

if  (NTIME  .aq.  1)  go  to  550 
C 


1 


if  (NUMIN  .aq.  1)  than 
ZA1-ZA3 
ZB1-2B3 
ZC1-ZC3 
FA1-FA3 
FB1-FB3 


2A3-IMA 

ZB3-IMB 

ZC3-IMC 


SO  to  650 

alaaif  (HUMIN  .aq.  2)  than 


ZA2-ZA3 

ZB2-ZB3 

ZC2-ZC3 

FA2-FA3 

FB2-FB3 

FC2-FC3 

ASIGN-FA3 

BSIGN-FB3 

CSIGN-FC3 

if  (aha(FAl-FA2) 

. aq.  0 

if  (aba (FB1-FB2 ) 

.  aq.  0 

if  (aba(FCl-FC2) 

. aq.  0 

if  (aba(FAl-FA2) 

.na .  0 

it  (aba(FBl-FB2) 

.na .  0 

if  (aba(FCl-FC2) 

.na .  0 

go  to  650 

C  .  . 


alsa 

"A"  Lag  •  •  • 

if  (FA3  . na.  0.)  than 
if  (FA1*FA2  .It.  0.)  than 
if  (FA1*FA3  .It.  0.)  than 
ZA2-ZA3 
FA2-FA3 

if  (FA3*ASIGH  .st.  0.)  FA1-FA1/2. 
ZA3-ZA2-FA2*(ZA2-ZA1)/ (FA2-FA1) 
alaaif  (FA1*FA3  .st.  0.)  than 
ZA1-ZA3 
FA1-FA3 

if  (FA3*ASIGH  .st.  0.)  FA2-FA2/2. 

2A3-ZA2-FA2* ( ZA2-ZA1 > / (FA2-FA1 ) 
and  if 

aiiaif  <FA1*FA2  .st.  0.)  than 

.Cautioua  forward  itaration  uains  halving  and  chacking  achama  in 
unbrackatad  ragion. 

if  (AHALF  .aq.  0)  than 
ZA1-ZA2 
ZA2-ZA3 
FA1-FA2 
FA2-FA3 

2A3-ZA1+ ( ZA2- ZA1 ) / 2 . 

AHALF- 1 

alaaif  (AHALF  .aq.  1)  then 
if  (FA1*FA3  .It.  0.)  than 
AHALF-0 
ZA2-ZA3 
FA2-FA3 

2A3-ZA2-FA2* ( ZA2- ZA1 ) / ( FA2-FA1 ) 
alaaif  (FA1»FA3  .gt.  0.)  than 
AHALF-0 


if  (aba(FA2-FAl)  .aq.  0.)  FA2-FA2/2. 

if  (aba(FA2~FAl) . na.O . )  ZA3-ZA2-FA2*(ZA2-ZA1)/(FA2-FA1> 
andif 
•ndif 

alaaif  (FA1*FA2  .aq.  0.)  than 
ZA1-ZA2 
ZA2-ZA3 
FA1-FA2 
FA2-FA3 

if  <aba(FA2-FAl)  .aq.  0.)  FA2-FA2/2. 

if  ( aba ( FA2- FA1 )  .na.  0.)  ZA3-ZA2-FA2* ( ZA2- ZA1 ) / ( FA2-FA1 ) 
andif 
andif 

C  . . .  ”B”  Lag  ... 

if  (FB3  .na.  0.)  than 
if  (FB1*FB2  .It.  0.)  than 
if  (FB1*FB3  .It.  0.)  than 
ZB2-ZB3 
FB2-FB3 

if  (FB3*BSIGN  ,gt.  0.)  FB1-FB1/2. 
ZB3-ZB2-FB2*<ZB2-ZB1)/(FB2-FB1) 
alaaif  (FB1*FB3  .gt.  0.)  than 
ZB1-ZB3 
FB1-FB3 

if  <FB3*BSIGH  .gt.  0.)  FB2-FB2/2. 

ZB3“ZB2-FB2*  <  ZB2-ZB1 > / (FB2-FB1 ) 
andif 

aiaaif  (FB1*FB2  .gt.  0.)  than 

C  . . .Cautioua  forward  itaration  uaing  halving  and  chacklng  achama  in 
C  unbrackatad  ragion . 

if  (BHALF  .aq.  0)  than 
ZB  1- ZB  2 
ZB2-ZB3 
FB1-FB2 
FB2-FB3 

ZB3“ZBl+(ZB2-ZBl)/2. 

BHALF- 1 

alaaif  (BHALF  aq.  1)  than 
if  (FB1*FB3  It.  0. )  than 
BHALF-0 
ZB2-ZB3 
FB2-FB3 

ZB3-ZS2-FB2*(ZB2"ZB1) / (FB2-FB1) 
alaaif  (FB1*FB3  gt.  0.)  than 
BHALF-0 


...  » ■ »  «.-»  »  ■_>  a_i  t.t  ut 


‘Jia 
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j 


FBl*FB2 

FB2-FB3 

if  (aba(FB2-FBi>  . aq.  0.)  FB2-FB2/2. 

if  <aba(FB2-F81).na.O. )  ZB3-ZB2-FB2*(ZB2-ZB1)/(FB2-FB1) 


alaaif  (FB1*FB2  .aq.  0.)  than 
ZB  1- ZB  2 
ZB2-ZB3 
FB1-FB2 


if  ( «b« (FB2-FB1 )  . aq.  0.)  FB2-FB2/2. 

if  <aba(FB2-FBl>  .na.  0.)  ZB3-ZB2-FB2«(ZB2-ZB1) / (FB2-FB1 ) 


C  . . .  "C"  Lai  ... 

if  (FC3  .na.  0.)  than 
if  (FC1*FC2  .it.  0.)  than 
if  <FC1*FC3  .it.  0.)  than 
ZC2-ZC3 
FC2-FC3 

if  (FC3»CSIGN  .it.  0.)  FC1-FC1/2. 

ZC3-ZC2-FC2* ( ZC2-ZC1 ) / (FC2-FC1 ) 
alaaif  <FC1»FC3  .it.  0.)  than 
ZC1-ZC3 
FC1-FC3 

if  <FC3*CSIGN  .it.  0.)  FC2-FC2/2. 

ZC3-ZC2-FC2* ( ZC2-ZCX ) / (FC2-FC1 ) 
andif 

alaaif  (FC1»FC2  .it.  0.)  than 

C  . . .Cautious  forward  itaration  uaini  halving  and  chackini  achama  in 
C  unbrackatad  ration. 

if  (CHALF  . aq.  0)  than 
ZC1-ZC2 
ZC2-ZC3 
FC1-FC2 
FC2-FC3 

ZC3“ZCl+(  ZC2-ZC1 )  /  2  . 

CHALF- 1 

alaaif  (CBAIF  .aq.  1)  than 
if  (FC1*FC3  .it.  0.)  than 
CHALF-0 
ZC2-ZC3 
FC2-FC3 

ZC3-ZC2-FC2«(ZC2-ZC1)/(FC2-FC1) 
alaaif  (FC1*FC3  ,st.  0.)  than 


ZC2-ZC3 


FC2-FC3 


I, 


if  (abs(FC2-FCl )  .eq.  0.)  FC2-FC2/2. 

if  ( abs ( FC2-FC1 ) . ne . 0 . )  ZC3-ZC2-FC2*(ZC2-ZC1)/(FC2-FC1) 
•ndif 
•ndif 

•lseif  (FC1*FC2  .eq.  0.)  then 
ZC1-ZC2 
2C2-ZC3 
FC1-FC2 
FC2-FC3 

if  (ebs<FC2-FCl)  .eq.  0.)  FC2-FC2/2. 

if  (abs(FC2-FCl)  .ne.  0.)  ZC3-ZC2-FC2*(ZC2-ZC1)/(FC2-FC1) 
•ndif 
•ndif 


•ndif 

ASIGN-FA3 

BSIGN-FB3 

CSIGN-FC3 

if  (abs(ZA3) 

.gt.  l.E-4) 

RERRZA-abs (FA3/ZA3 ) 

if  (abs(ZA3) 

.le.  l.E-4) 

RERRZA-aba (FA3 ) 

if  (aba(ZB3) 

.gt.  l.E-4) 

RESRZB-abs ( FB3 / ZB3 ) 

if  (abs(ZB3) 

.le.  l.E-4) 

R£RRZB_abs ( FB3 ) 

if  (abs(ZC3) 

.gt.  l.E-4) 

R£SRZC-abs(FC3/ZC3) 

if  (abs(ZC3) 

•le.  l.E-4) 

R£RR2C-abs(FC3) 

if  ( (RERRZA  .It.  l.E-6)  .and.  (RERR2B  .It.  l.E-6)  .and. 

+  (RERRZC  .It.  l.E-6))  go  to  530 

C 

650  continue 

c  ***************************** 

C  *****  End  of  inner  loop  ***** 

c  ••••••••••••••••**•••**•**••* 

c 

call  GOTOXY (23,12) 

»rite(* , 851)  TIME 

651  fonnat( lz, 'Stiff  Phase  Current  Characteristics  at  ' ,F8.7, 

*  *  seconds ' ) 

C 

530  TA»IMA*KT*BEMFA/KX3 
TB-IMB*KT*BEMFB/KK3 
TC-IMC*KT*BEMFC/KK3 
TM-TA+TB+TC 

call  TCONST ( ICTMF , TM , . OQS.NTIME, NTIM47 .DELTIM, TMF) 
Tf*MCT*IM 
TBM-BM*WM 
VKBWM-KBHJM 
C 

if  (WM  .It.  0.0)  go  to  180 
TH1-TM-TL 
go  to  185 


m 


i 


m 


m 


1 


•iS? 


M 


a 


ti 
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TN1-TM+TL 


TN2-TN1/B 


THETA1-THETA 


call  TCONST < WHO , TN2 , A2 , NTIME , NTIM4 8 , DELTIM , HM ) 
call  INTGRL (NTIME , NTIM23 , DELTIM , THETAO , FREV7 , WM , CURV7 , 
HOLD3 , PTHETA) 


THETA-PTHETA 


F3-THETA-TBETA1 


MODIFIED  LINEAR  INTERPOLATION 


if  (NTIME  .eq.  1)  go  to  601 


if  (NUMIT  .aq.  1)  than 


X3-THETA 


go  to  300 

alaaif  (NUMIT  .aq.  2)  than 
X2-X3 


if  (aba(F2-Fl)  .aq.  0.)  F2-. 5*F2+1 .E-6 
if  (aba(F2'Fl)  ,na.  0.)  X3-X2-F2*(X2-X1)/(F2-F1) 


TSIGN-F3 


go  to  300 

alaaif  (F3  . na.  0.)  than 
if  (F1*F2  .It.  0.)  than 
if  (F1*F3  .It.  0.)  than 


if  (F3*TSIGN  .gt.  0.)  Fl-Fl/2. 
X3“X2-F2*(X2-X1 ) / (F2-F1 ) 
alaaif  <F1*F3  .gt.  0.)  than 
X1-X3 


if  (F3*TSIGN  .gt.  0.)  F2-F2/2. 
X3-X2-F2*(X2-X1)/(F2-F1) 


alaaif  (F1*F2  .gt.  0.)  than 

.Cautioua  forward  itaration  using  halving  and  chacking  schema  in 
unbracketed  region. 

if  (HALF  .aq.  0)  than 


X3-Xl+(X2-Xl)/2. 

HALF-1 


alaaif  (HALF  .  aq.  1)  than 
if  (F1*F3  .It.  0.)  than 
HALF-0 
X2-X3 
F2-F3 

X3-X2-F2*(X2-X1)/(F2-F1) 
alaaif  (F1*F3  .gt.  0.)  than 
HALF-0 
X1-X2 
X2-X3 
F1-F2 
F2-F3 

if  (aba(F2-Fl)  .aq.  0.)  F2-F2/2. 
if  (aba(F2-Fl)  .na.  0.)  X3-X2-F2*CX2-X1)/(F2-F1) 
and  if 
and  if 

alaaif  (F1*F2  .aq.  0.)  than 
X1-X2 
X2-X3 
F1-F2 
F2-F3 

if  (aba(F2-Fl)  .aq.  0.)  F2-F2/2. 
if  (aba(F2-Fl)  .na.  0.)  X3-X2-F2*(X2-X1)/(F2-F1) 
andif 
andif 

if  (aba(X3)  .gt.  l.E-4)  R£LEHR-aba(F3/X3) 
if  (aba(X3)  .la.  l.E-4)  RELERR-aba (F3 ) 

if  (RELERR  .It.  l.E-6)  go  to  601 
500  continua 

call  GOTQXY(24 , 15) 
writa(* . 852)  TIME 

652  f ozmat ( lx FAILED  Convacganca  of  Outar  Loop  at  ',F8.7,  ’  aaconda’) 


601  WMRPPH*t*30./PI 

THDEG-THETA* 180.0 /PI 

X3-THETA-H*J*DELT  IM 

THETAF-REDRAT-THETA* 180 . /PI 

OMEGAF-R£DRAT*WM*180 . /PI 

PREIMA-ZA3+ . 5»0IADT*DELTIM 

FREIMB-ZB3+. 5*0IBDT*DELTIM 

FREIMC-ZC3+ . 5*DICDT*DELTIM 

ZA3-PREIMA 

ZB3-PREIMB 

ZC3-PREIMC 

DIRM1-DIR 


S' 


C  *****  End  outer  loop  ***** 
c  **•**.****•*****•••*.***•• 

c 

C  ...  Generate  Plotting  Arrays  . . . 


if  (TIME  .ga.  BEGTIM)  than 
NCTR-NCTR+1 

if  ( (mod(HCTR,SIM2PL)  .aq.  0)  .or.  (NCTR  .eq.  1))  then 
NPTS-NPTS+1 

C  ...  Output  data  to  fila  for  future  retrieval  and  plotting 
C 

XTIME(NPTS)-TIME 

C 

wr i te ( 4 , 1200 )  TIME , THETAF , ORDER , OMEGAF , NODE , PLUG 
write(5, 1210)  IM, IMA, IMB , IMG ,TM, TMF 
write ( 6 , 1220)  VD1D,VD2D,VD3D,VD4D,VD5D,VD6D 
write<7, 1230)  SW1 , SW2 , SW3 , SW4 , SW5 , SW6 
1200  format (57 15 . 7 , 3X, 13) 

1210  format(6F15.7) 

1220  format (6715. 7) 

1230  format (675. 2) 

endif 
endif 

100  CONTINUE 

clcae(4,STATUS-’KEEP' ) 
close ( 5 , STATUS- * KEEP ' ) 
c lose ( 6 , STATUS- ' KEEP ' ) 
c lose ( 7 , STATUS- ' KEEP’ ) 

C 

c  .*•*..****...*......*.***.**** 

C  *****  Plotting  selection  ***** 

c  ****************************** 

c 

C  ***  Clear  Screen  &  Borne  Cursor  *** 

400  call  CLRSCR 
C 

write(*, 1305) 
raad(*, ’ (A) ’ )  DISOPT 
C 

if  ((DISOPT  .eq.  'm' )  .or.  (DISOPT  .eq.  ’M’))  then 
MODEL-98 
IOPORT-98 

elseif  ((DISOPT  .eq.  ’ p’ )  .or.  (DISOPT  .eq.  ’P’))  then 
MODEL-FMODEL 
IOPORT-1 

C  ...  Ioport-9600  is  C0M1  . . . 

C  ...  Ioport-9650  is  COM2  . . . 

if  ((MODEL  . eq.  20)  .or.  (MODEL  .eq.  30))  IOPORT-9650 
elseif  ((DISOPT  .eq.  'r’>  .or.  (DISOPT  .eq.  'R'))  then 
GO  TO  13 

elseif  ((DISOPT  .eq.  ’w’ )  .or.  (DISOPT  .eq.  ’W’))  then 


c 

c  •*****.*.**....*.***«***.*********•***...*.* 

C  *****  Output  Simulation  Specs  to  Printer  *** 

C  *•*•****.*•**********.**..**.«.*•******•**** 

C 

call  FRNOUT ( BEGTIM , FINTIM , PTSPLT , MAXITS , SIM2PL , DELTIM , NTERMS , 
+  EO , EDOTO . TYPE , STPMAG , RSLOPE , SINAMP , SINFRQ , SINPHA , 

+  NLCHAR.DBAND, PERIOD, KPWM.RIN, ROUT, RDAD J , KTM , KBM , 

+  KV,KP,RA,LA,BM,BL,  JM,  JL.RSAT ,RCUT ,TTIME,RS , THADV, 

+  TDPLUG) 

C 

go  to  400 
C 

elseif  ((DISOPT  .eq.  's’ )  .or.  (DISOPT  ,sq.  ’S’))  then 
C 

C  .******************..******************* 

C  ***  OPEN/WRITE /CLOSE  INPUT  DATA  FILE  *** 

C  .*•«**.*******•**.**«**.***************• 

C 

open ( 2 , FILE- 1  MOTOR . INP ’ , STATUS- ' OLD ’ , ACCESS- ' SEQUENTIAL ’ ) 
write(2, 1000)  PMODEL , PRTCHR , RIN , ROUT , RDAD J 
write(2, 1020)  BEGTIM, FINTIM, PTSPLT, MAXITS, SIM2PL 
write(2, 1022)  KFWM,KV,E0, EDOTO, TTIME , XORG , YORG 
write(2, 1024)  RS.RSAT, JL.BL.KTM 
write(2, 1026)  JM.RA, LA, KBM, THADV. TDPLUG 
write(2, 1028)  BM,KP, PERIOD, DBAND.KA 
write(2, 1030)  TYPE, RCUT, STPMAG, RSLOPE 
write (2, 1032)  SINAMP , SINFRQ , SINPHA , DRIVE 
close (2, STATUS- ‘KEEP’ ) 

C 

go  to  400 
C 

elseif  ((DISOPT  .eq.  ’Q’ >  .or.  (DISOPT  ,eq.  ’q’))  then 
GO  TO  460 

else 

go  to  400 
end  if 

C 

call  DISPLAtXORG, YORG, DISOPT, PRTCHR, ELEMNT, DRIVE, XTIME) 

C 

go  to  400 
460  continue 
C 

C  ***  I/O  Statements  *** 

C 

4  f onset (//////, 25X, ’«**  BRUSHLESS  DC  MOTOR  SIMULATION  ****,//, 
+  25X, ’  Vincent  S.  Rossitto’,/, 

+  25x,’  Naval  Postgraduate  School’,//////) 

C 

5  format(32X, ’•**  MAIN  MENU  ***’,//, 

+  20X, ’ ( H ] - »  HARDWARE  Configuration  Menu’,/, 
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+  20X,'[M] - >  MOTOR  Parameter  Menu',/, 

+  20X,’(N] - >  NON-LINEAR  Element  Selection  Menu’,/, 

+  20X, ' (0] - >  OPTIONS  lor  Simulation’,/, 

+  20X,’[C] - »  C06MAND  Input  Selection  Menu',/, 

+  20X,'[S) - >  SAVE  All  Changes’ ,/, 

+  20X, ’ [RJ - >  RUN  Simulation  Program’,/, 

+  20X, ’ [Q] - >  QUIT  the  Program’,//, 

+  8X, 'ENTER  SELECTION - »',\) 

C 

105  format(30X, ’***  HARDWARE  MENU  ***’,//, 

+  20X, ' t P] - »  PRINTER/ PLOTTER  configuration  change',/, 

+  20X , ’ [Q] - >  QUIT  THIS  MENU' ,//, 

+  8X, ’ENTER  SELECTION - >’,\) 

1000  format ( IX, 13 , 2X, A51 , 2X , 3F15 . 7 ) 

1020  format ( IX, 4F 15. 7, IX, 13) 

1022  format ( IX, 7F15 , 7 ) 

1021  formatt IX, 5F15 . 7) 

1026  formate  IX, 6F15. 7) 

1028  formate IX, 5F 15 . 7 ) 

1030  formate IX, A15, 3F 15 . 7 ) 

1032  format ( IX, 3F15 . 7 , IX, A3 ) 

2000  formate IX, 'END  OF  FILE') 

C 


240  format e 12X ,  '  ***  SIMULATION  OPTIONS  MENU  **•',//, 


+  1X.F15.7.1X, ' [BEGTIMJ 
+  1X.F15. 7, IX, ’ [FINTIM] 
+  1X.F15.7.1X, ' [PTSPLT] 
+  1X.F15. 7 ,  IX, * [MAXITS] 
+  13X.I3.1X,  ' [SIM2PL] 

+  1X.F15. 7 , IX, ’ [E0] 

+  1X.F15 . 7 , IX, ’ [EDOTO] 

+  1X.F15. 7, IX, ’ tXORG] 

+  1X.F15 . 7, IX, ' [YORG] 


Start  Time  of  Plotting  Window',/, 

Stop  Time  of  Plotting  Window' , / , 

Points  to  be  Plotted  per  Curve’,/, 

Max  Number  of  Simulation  Iterations’,/, 
Ratio:  Points  Simulated/Plotted',/, 
Initial  Fin  Position  ERROR  (deg)',/, 
Initial  Fin  Velocity  ERROR  Cdeg/s)’,/, 

X  Coordinate  of  Plotting  Origin’,/, 

Y  Coordinate  of  Plotting  Origin’,/, 
Drive  (d:>  for  Virtual  Memory’,/, 


+  13X.A3.1X,  ’[DRIVE] 

+  17X,’[Q]  QUIT  THIS  MENU’,///, 

+  15X, ’Computed  simulation  step  size  - >  ’,F9.8,  ’seconds’,/, 

+  15X, 'Computed  total  number  of  steps - >  ’,16,//, 

+  IX, ’Enter  variable  name  (UPPERCASE)  or  Q  to  QUIT  - >  ’,\) 


245  formate 12X, ’***  COMMAND  INPUT  SELECTION  MENU  ***’,//, 

+  1X.A15, IX, ’ [TYPE]  STEP,  RAMP,  or  SINE  Response’,/, 


+  IX, FIS. 7 , IX, ’ [STPMAG] 
+  IX , FIS . 7 , IX, ' [RSLOPE] 
+  IX, FI 5. 7 , IX, ’ [SINAMP] 
+  1X.F15. 7 , IX, ’ [SINFRQ] 
+  1X.F15. 7 , IX, ’ [SINPHA] 


Coamanded  Position  for  STEF  Response', 
Slope  of  RAMP  Function’,/, 

Amplitude  of  SINE  Function',/, 
Frequency  (deg/sec)  of  SINE  Function’, 
Phase  Angle  (deg)  of  SINE  Function',/, 
+  17X,'[Q]  QUIT  THIS  MENU' ,///, 

+  IX, ’Enter  variable  name  (UPPERCASE)  or  Q  to  QUIT  - >  ’ . \ ) 


270  formate/// ,8X, ’***  NON-LINEAR  ELIMENT  SELECTION  ***',//, 
+  17X,  ' [R]  Relay  (Bang-Bang)’,/, 
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+  17X,  1  [P] 

+  IX, F15 . 7 , IX, ’ (KV] 
+  IX, FIS . 7 , IX, ' [KP] 
+  17X,  ' [Q] 


Pulse  Width  Modulator',/, 

Velocity  Feedback  Constant’,/, 

Position  Feedback  Constant',/, 

QUIT  THIS  MENU /RETURN  TO  MAIN  MENU',//, 


+  IX, 'Enter  Selection  — »  ’ , \ ) 


272  format(10X,  ’CURRENT  SELECTION  -->  ',A30) 

280  format (///,8X, •**»  SATURATING  AMPLIFIER  SPECIFICATIONS  ***',//, 
+  1X.F15. 7 , IX, ’ [DBAND]  Deadband  Applied  to  System  Feedback’,/, 

+  1X,F15.7,1X,’[KA]  Amplifier  Gain’ ,/, 

+  17X,’[QJ  QUIT  THIS  MENU’,//, 

+  IX, 'Enter  the  selection  (UPPERCASE)  - >  ’,\) 

290  formate /// , 15X, ’**»  RELAY  SPECIFICATIONS  **»’,//, 

+  IX ,F15 . 7 , IX, ' [DBANDJ  Deadband  Applied  to  System  Feedback’,/, 

+  17X, ’ [Q]  QUIT  THIS  MENU’,//, 

+  IX, 'Enter  the  selection  (UPPERCASE)  - >  ’,\) 

300  format (///.5X, ’ ***  PULSE  WIDTH  MODULATOR  SPECIFICATIONS  *••’,//, 
+  IX, FIS. 7, IX, ’ [DBAND)  Deadband  Applied  to  System  Feedback',/, 

+  1X,F15.7,IX, ' [PERIOD)  Period  of  PWM  Reference  Cycle ( sec) ’,/ , 

+  1X.F15 . 7 , IX, ' [KPWM]  PWM  Amplifier  Gain’,/, 

+  17X, ’ [Q]  QUIT  THIS  MENU’ ,//, 

+  IX, ’Enter  the  selection  (UPPERCASE)  - >  ' 


1305  FORMAT( /////, 2X, ’Display  options:’,/, 

+  SX.'CM)  MONITOR’ 

+  5X, ’ [P]  PRINTER',/, 

+  5X,’[R]  RETURN  TO  START-UP  MENU  (RE-INITIALIZE) ’ , / , 

+  5X,’[W]  WRITE  SIMULATION  SPECIFICATIONS  TO  PRINTER’,/, 

+  5X,’[S]  SAVE  SIMULATION  SPECIFICATIONS  TO  DISK’,/, 

+  3X,’[Q]  QUIT  THE  PROGRAM’,//, 

+  2X, ’Enter  selection  [M,P,R,W,S,Q]  — >  ’,\) 

1500  format ( IX, 13 , 2X , A50 ) 

STOP 
END 


BLDCM2A.FQR  (subroutines  PRNOPT,MOTPAR,DISPLA,PRNOUT) 

These  subroutines  are  compiled  as  a  group,  but  separately  from 
BLDCM1  &  BLDCM2A  due  to  size  limitations.  Subroutines  must  be 
linked  together . 

Last  Revision  — >  0*  April  1987 
LT  Vincent  S.  Rossitto,  USN 


***  PRINTER/PLOTTER  SELECTION  MENU  *** 


Provides  uaer  interface  for  aelection  of  Printer  for  output 
device. 

aubroutine  PRNOPT ( PMODEL , FRTSEL , PRTCHR ) 
implicit  REAL**  (A-Z) 
intagar*2  PMODEL 
charactar*6  PRTSEL 
charactar*51  PRTCHR 

call  CLRSCR 
write(* , 130 ) 
raad<* . ' (A) ' )  PRTSEL 

if  (PRTSEL  .aq.  ’O')  than 

PRTCHR-'Epaon  FX-80  Printar,  aingla  danaity' 
fMODEL-O 

alsaif  (PRTSEL  .aq.  ’1')  than 

PRTCHR-’Epaon  FX-80  Printar,  doubla  danaity' 

FMODEL-1 

alaaif  (PRTSEL  .aq.  '2')  than 

PRTCHR-'Epaon  FX-80  Printar,  dbla  apd.dual  danaity’ 
PMODEL-2 

alaaif  (FRTSEL  .aq.  ‘3’)  than 

PRTCHR-1 Epaon  FX-80  Printar,  quad  danaity' 

PMODEL-3 

alaaif  (PRTSEL  .aq.  ’*’)  than 

PRTCHR-' Epaon  FX-80  Printar,  CRT  Graphiea  X’ 

PMODEL-4 

alaaif  (PRTSEL  .aq.  '5')  than 

PRTCHR- 1 Epaon  FX-80  Printar,  plottar  graphiea’ 
PMODEL-5 

alaaif  (FRTSEL  .aq.  '6')  than 

PRTCHR-’ Epaon  FX-80  Printar,  CRT  Graphiea  XI’ 
PM3DEL-6 

alaaif  (PRTSEL  .aq.  '10')  than 

PRTCHR- 'Epaon  FX-100  Printar,  aingla  danaity' 
PMODEL-7 

alaaif  (PRTSEL  .aq.  ’ll’)  than 

PRTCHR- 'Epaon  FX-100  Printer,  doubla  danaity' 

PMODEL- 11 

alaaif  (FRTSEL  .aq.  ’12’)  than 

PRTCHR- 'Epaon  FX-100  Printar,  dbla  apd.dual  danaity' 
PMODEL- 12 

alaaif  (PRTSEL  .aq.  '13')  than 

FRTCHR- 1 Epaon  FX-100  Printar,  quad  danaity’ 

FMODEL-13 

alaaif  (PRTSEL  .aq.  ’14’)  than 

PRTCHR- 'Epaon  FX-100  Printar,  CRT  Graphiea  I’ 
IMODEL-14 

alaaif  (PRTSEL  .aq.  '15’)  than 

PRTCHR- ' Epaon  FX-100  Printar,  plottar  graphiea’ 
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fWODEL-15 

elseif  (PRTSEL  . aq.  '16')  then 

PRTCHR* ' Epson  FX-100  Printer,  CRT  Graphic*  II* 
PMODEL-16 

elseif  ( PRTSEL  ■ »q.  '20')  than 

PRTCHR-’HP  7470A  Graphic*  Plotter' 

PMODEL-20 

elseif  (PRTSEL  aq.  ’30‘)  than 

PRTCHR-'HP  7475A  Graphic*  Plottar' 

WODEL-30 

elseif  (PRTSEL  aq.  '60')  than 

PRTCHR-'HP  2686A  Laser  Jat  Printar’ 

FMODEL-60 

C 

C  ...  Quit  tha  Printar  Manu  .  .  . 

aliaif  ((PRTSEL  .aq.  'Q*)  .or.  (PRTSEL  .aq.  'q'))  than 
go  to  101 

alsa 

go  to  131 
and  if 

101  continua 

C 

130  FORMAT ( 24X. '***  PRINTER  OPTIONS  MENU  *»*',//, 

+  15X,’[0]  - - »  Epson  FX-80  Printar,  single  density 

+  15X,'[1]  — >  Epson  FX-80  Printar,  double  density',/, 

+  15X,’[2]  --»  Epson  FX-80  Printar,  dble  spd , dual  density’,/, 

♦  13X, ‘ [3]  --»  Epson  FX-80  Printar,  quad  density’,/, 

+  15X, ' [4J  --»  Epson  FX-80  Printar.  CRT  Graphics  I*,/, 

+  15X,’(5]  -->  Epson  FX-80  Printer,  plottar  graphics*,/, 

+  15X,*[6]  — »  Epson  FX-80  Printar,  CRT  Graphics  II'./, 

+  15X,'tlO]  ->  Epson  FX-100  Printar,  single  density',/, 

+  1SX,*(11]  ->  Epson  FX-100  Printar,  double  density’,/, 

♦  15X,’tl2]  ->  Epson  FX-100  Printar,  dble  spd, dual  density',/, 

+  15X,’[13]  -»  Epson  FX-100  Printar,  quad  density',/, 

+  15X,’(14]  -»  Epson  FX-100  Printar,  CRT  Graphic*  I’,/, 

+  15X,'[13]  ->  Epson  FX-100  Printer,  plottar  graphics’,/, 

+  1SX, * (16]  -»  Epson  FX-100  Printar,  CRT  Graphics  II*,/, 

+  15X, ’ [20]  -»  HP  7470A  Graphics  Plotter’,/, 

+  15X, ' [30]  -»  HP  7475A  Graphics  Plotter',/, 

+  15X,’[60]  ->  HP  2686A  Laser  Jat  Printar  (NPS  installation)’,/ 

+  15X,’(Q]  — »  QUIT  THIS  MENU’ ,//, 

♦  3X, 'Enter  Printar  Selection  Integer  or  Q  to  QUIT  - >  ' , \ ) 

return 

and 

C . 

C  «••»••****•*•••**•*•**♦*•»*•*•*»*****•••• 

C  »***  Motor  Parameter  Input  Subroutine  *** 
c  ***.•..*..*.•••***.*.»»*****»**•••**•*»*. 

C 

subroutine  MOTP AR ( KTM , KBM , RIN , ROUT , RDAD J ,RA,LA,BM,BL,JM,JL, 

+  RSAT , RCUT , TTIME , RS , THADV , TBPLUG ) 


implicit  REAL(A-Z) 
character*6  ANS21 

call  CLRSCR 

write(*,230)  KTM, KBM, RIN  ROUT .RDADJ, RA, LA, BM, BL , JM, JL . 

RSAT , RCUT , TT IME , RS , THADV , TDPLUG 
read(», ' CA) * )  ANS21 

i£  (ANS21  . aq.  'KTM' )  than 
call  GOTOXY (24,1) 

write(*, ‘ (A\ ) ’ ) 'Enter  a  REAL  valua  for  KTM— >  1 
read(»,»)  KTM 
go  to  201 

alaaif  (ANS21  .aq.  ’KBM’ )  than 
call  GOTOXY (24,1) 

write(*, ' (A\ ) ' ) 'Entar  a  REAL  valua  for  KBM-->  ' 
read(*,»)  KBM 
go  to  201 

alaaif  (ANS21  .aq.  'RIN’)  than 
call  GOTOXY (24 , 1) 

writa(*, ’ <A\ ) • ) 'Entar  a  REAL  valua  for  RlH-->  ’ 
raad(* ,*)  RIN 
go  to  201 

alaaif  (ANS21  aq.  'ROUT')  than 
call  GOTOXY (24,1) 

writa(«, ‘ (A\ )•) 'Enter  a  REAL  valua  for  ROUT-->  ' 
raad(*,*)  ROUT 
go  to  201 

alaaif  (ANS21  .aq.  'RDADJ' )  than 
call  GOTOXY (24 , 1) 

«rita(*, '  (A\ ) ' )  ’Entar  a  REAL  valua  for  RDADJ— »  • 
raad(*,*)  RDADJ 
go  to  201 

alaaif  (ANS21  .aq.  'RA')  than 
call  GOTOXY (24, 1) 

wrlte(«,’(A\)') 'Enter  a  REAL  valua  for  RA— »  ' 
raad(*,*)  RA 
go  to  201 

alaaif  (ANS21  aq.  ’LA1 )  then 
call  GOTOXY(24 , 1} 

writa(*, ’(A\)’ ) ’Enter  a  REAL  valua  for  LA— »  ’ 
read<*.*)  LA 
go  to  201 

alaaif  (ANS21  .aq.  ’BM' )  than 
call  GOTOXY (24 , 1) 

write(*,  ■  (A\ ) '  )  ’Enter  a  REAL  valua  for  BM— >  ■ 
raad(*,»)  BM 
go  to  201 

alaaif  (ANS21  .aq.  'BL')  than 
call  GOTOXY(24 , 1 ) 

write (*,  ’  (A\ ) '  ) '  Entar  a  REAL  value  for  BL— »  ' 
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read(*,*)  BL 
go  to  201 

alsaif  (ANS21  . aq .  'JM')  than 
call  GOTOXYC24 , 1 ) 

write(*, ' (A\ )') 'Enter  a  REAL  value  for  JM-->  * 
raad(*,*>  JM 
go  to  201 

alsaif  (ANS21  .aq.  'JL’>  then 
call  GOTOXYC24 , 1 ) 

write(* (A\ )') 1  Enter  a  REAL  value  for  JL — >  ' 
read{*,*)  JL 
go  to  201 

alsaif  (ANS21  aq.  ’RSAT’ )  than 
call  GOTOXY(24 , 1 ) 

write(*. 1 (A\ )’> 'Enter  ■  REAL  value  for  RSAT — >  ’ 
read(*,*)  RSAT 
go  to  201 

alsaif  (ANS21  .aq.  'RCUT')  than 
call  GOTOXYC24 , 1) 

write(», * (A\ >' )'Entar  a  REAL  value  for  RCUT-->  ' 
read(* , * )  RCUT 
go  to  201 

alsaif  (ANS21  .aq.  'TTIME')  than 
call  GOTQXY (24,1) 

write(*, ‘ (A\ ) ' ) 'Enter  a  REAL  value  for  TTIME--*  ’ 
raad(*,«)  TTIME 
go  to  201 

alsaif  (ARS21  aq.  'RS')  than 
call  GOTCQCY(24,l> 

writa(*. ' (A\ ) ' )' Enter  a  REAL  value  for  RS-->  ’ 
read(»,#)  RS 
go  to  201 

alsaif  (ANS21  aq.  'THADV' )  than 
call  GOTQXY (24 , 1 ) 

writa(*. ' (A\ )’) ’Enter  a  REAL  value  for  THADV — >  ’ 
raad(*,*)  THADV 
go  to  201 

alaaif  ( AHS21  .aq.  • TO PLUG ’ )  than 
call  GOTOKY(24,1) 

write(*. ’ (A\ )’) 'Enter  a  REAL  value  for  TDPLUG--* 
read(«,*)  TDPLUG 


go  to  201 
Quit  Motor  Para 


stars  Menu 


alsaif  (AHS21  .aq.  'Q')  than 
go  to  1 

alsa 

go  to  201 
and  if 


formatUOX,  ’MOTOR  PARAMETER  SELECTION  MENU',//, 


+  IX, FIS.  7,  IX,  •  [KIM] 

♦  IX , FIS . 7 , IX, ’ [KBM] 

♦  IX, FIS . 7 , IX, ' [RIN] 

+  IX , FIS . 7 , IX, ’ [ROUT] 

+  1X.F15 . 7 , IX, • [ROADJ] 
+  IX, FIS . 7 , IX, ' [RA] 

+  1X,F15.7,1X. 1 [LAI 
+  IX, FIS. 7, IX, ' [BM] 

+  1X.F15. 7, IX, ’ [BL] 

+  IX, FIS . 7 , IX, * [  JM] 

+  1X.F15.7.1X, • [JL] 

+  1X.F15. 7 , 3X, ’ [RSAT] 

+  IX, FIS. 7, IX, * [RCUT] 

+  1X.F15 . 7 , IX, ' [TTIME] 
+  IX, FIS. 7, IX, ’ [RS] 

+  1X,F1S.7,1X,'[THADV] 


Motor  Torque  Constant',/, 

Motor  Back  Off  Constant' ,/, 

Currant  Limiting  Rasistanca  (inside)', 
Currant  Limiting  Rasistanca  (outside)' 
Sarias  R  Addad  to  Freewheeling  Diodas’ 
Motor  Fhasa  Rasistanca (Ohm) ',/ , 

Motor  Phasa  Inductanca(Eanrias) ' , / , 
Motor  Viscous  Friction  Coaff',/, 

Load  Viscous  Friction  Coaff',/, 

Motor  Inertia(os-ln/s~2) ’ , / , 

Load  Inertia(oz-in/s~2) ’ , / , 

Equiv  Ckt  Rasistanca  of  Trans  Satur',/ 
Equiv  Ckt  Rasistanca  of  Trans  Cutoff  , 
Transistor  Switching  Tima’,/, 

Intamal  Rasist  of  Supply  Voltaga',/, 
Commutation  Advanca  (Elactrical  Dag)’, 


+  1X.F15. 7 , IX, ’ [TDPLUG]  Commutation  Daad  Tima  whila  Plugging’ 


♦  10X, ’ [Q] 


QUIT  THIS  MENU’ ,//, 


+  IX , ' Entar  Variable  Hama ( UPPERCASE )  or  Q  to  QUIT  - >  ’,\) 


***  GRAPHIC  OUTPUT  SELECTION  MENU  *** 


Provides  user  selection  for  graphic  output  of  data. 


subroutine  DISPLA (XORG.YORG.DISOPT, PRTCHR, ELEMNT, DRIVE, XTIME) 
implicit  real**  (A-Z) 

common  BEGTIM, FINTIM , NPTS , IOPORT .MODEL ,XLEN , YLEN , PLEN , PLEN1 , 
►  XTITLE , YTITLE , PTITLE , PTIT1 

real**  XTIME ( 1010) ,T1(1010) , Y2( 1010 ) 
intagar*2  NPTS , PCTR , XLEN , YLEN , IOPORT , MODEL , ELEMNT 
character*3  DISOPT.PLOPT.DRTVE 
charaetar*2S  XTITLE, YTITLE 
character*!!  PRTCHR, PTITLE, PTIT1 


***  Clear  Screen  A  Home  Cursor  *** 

A 10  call  CLRSCR 

if  (CDISOPT  .eq.  'p')  .or.  (DISOPT  .aq.  ’P’))  than 
call  OOTQXY (24,20) 
writer,*)  PRTCHR 
call  QOTQXYd,  1) 


writa(* , 1300) 
raad(* , ' (A) 1 )  PLOPT 

if  ((PLOPT  aq.  ’Q')  .or.  (PLOPT  .aq.  ’q’))  than 


rt  I1! 


(0  to  400 

alaaif  (PLOPT  .aq.  'X')  than 
XTITLE-' TIME  (aaconda)’ 

XLEN— 15 

YTITLE-’FIN  POSITION  (dag)’ 

YLEN-19 

if  ( ELEMNT  . aq.  1)  than 

PTITLE-'FIN  POSITION  RESPONSE  WITH  RELAY  CONTROLLER' 

PLEN-44 . 

alaaif  (ELEMNT  .aq.  3)  than 

PTITLE-’FIN  POSITION  RESPONSE  WITH  PWM  CONTROLLER' 

PLEN-42. 

andif 

PT IT 1-' BRUSHLESS  DC  MOTOR' 

PLEN1-20. 

C 

C  ...  Data  Ratriaval  . . . 

if  (DRIVE  .aq.  'A')  than 

opan(4 , f ila-’ a : BLDCM1 . VIR' ,atatua-’OLD’ , accaaa-’ SEQUENTIAL’ ) 
alaaif  (DRIVE  .aq.  'B')  than 

opan ( 4 , f i la- ' b : BLDCM1 . VIR ' ,atatua-'OLD’ .accaaa-' SEQUENTIAL' ) 
alaaif  (DRIVE  aq.  'C' )  than 

opan(4.fila-'e:BLDCMl.VIR' .atatua-'OLD’ , accaaa-' SEQUENTIAL ’ ) 
andif 

do  830  PCTR-l.NPTS 

raad( 4 , S30 )  THETAF, ORDER 
930  format (13x,2Fl 5. 7) 

Y1(PCTR)-THETAF 
Y2(PCTR) -ORDER 
830  continua 

cloaa(4 , atatua-'KEEP’ ) 

C 

call  MGRAPH(XTIME ,  Y1 ,  Y2  ,XORG,  YCRG,  DISOPT  ) 

C 

alaaif  (PLOPT  .aq.  '2')  than 
XTITLE- ' TIME  (aaconda ) ’ 

XLEN— 15 

YTITLE-'FIN  VELOCITY  (dag(aac)' 

YLEN-23 

if  (ELEMNT  .aq.  1)  than 

PTITLE-’FIN  VELOCITY  RESPONSE  WITH  RELAY  CONTROLLER' 
PLEN-44. 

alaaif  (ELEMNT  .aq.  3)  than 

PTITLE-’FIN  VELOCITY  RESPONSE  WITH  FVW  CONTROLLER’ 

PLEN-42. 

andif 

PTIT1-’ BRUSHLESS  DC  MOTOR' 

PLEN1-20 . 

C 

C  .  ..  Data  Ratriaval  .  .  . 

if  (DRIVE  ,aq.  'A’)  than 
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opant 4 , fila*' a :BLDCM1 . VIR' , atatua- 'OLD ' , accaaa- ’ SEQUENTIAL ’ ) 
alaaif  (DRIVE  .  aq.  ‘B'>  than 

opant  4 , fila- ' b : BLDCH1 . VIR’ , atatua- 'OLD ' . accaaa-' SEQUENTIAL ' ) 
alaaif  (DRIVE  .aq.  'C')  than 

opan ( 4  ,  fila- '  c  : BLDCM1 .  VIR ’  ,  atatui-' OLD' ,  accaif  SEQUENTIAL '  ) 
and  If 

do  832  PCTR-l.NPTS 

ra«d( 4 , 932)  OMEGAF 
Y1(PCTR)*CMEGAF 
continua 

format ( 4  3X , F 1 3 . 7 ) 
cloaa(4 , atatua-'KEEP’ ) 

call  GRAPH (XTIME , Y1 , XORG , YORG , DISOPT ) 

alaaif  (PLOPT  .aq.  '3’)  than 
XTITLE-'TIME  (aaeonda)' 

XLEH— 15 

YTITLE-’IM  (ampa)' 

YLEH-10 

if  (ELEMHT  aq.  1)  than 

PTITLE-' MOTOR  SOURCE  CURRENT  WITH  RELAY  CONTROLLER' 

PLEN-43. 

alaaif  (ELIMNT  .aq.  3)  than 

PTITLE-' MOTOR  SOURCE  CURRENT  WITH  PWM  CONTROLLER’ 

PLEN-41. 

andif 

PTIT1-' BRUSHLESS  DC  MOTOR’ 

PLEN1-20. 

.  Data  Ratriaval  . . . 

if  (DRIVE  .aq.  'A')  than 

opan(3.flla-'a:BLDCM2.VIR’ ,atatua-’OLD’ , accaaa-’ SEQUENTIAL ’ ) 
alaaif  (DRIVE  .aq.  'B')  than 

opan(S, fila~'b : BLDCM2. VIR’ .atatua-' OLD' .accaaa- 'SEQUENTIAL' ) 
alaaif  (DRIVE  .aq.  'C')  than 

opan(5, fila-' c : BLDCM2 . VIR’ , atatua-'OLD' , accaaa-' SEQUENTIAL' ) 
andif 

do  833  PCTR-l.NPTS 
raad(5, 933 )  IM 
Y1(PCTR)-IM 
continua 
format(F13.7> 
c loaa ( 5 , atatua- ’ KEEP ' ) 

call  GRAPH (XTIME, Yl, XORG, YORG, DISOPT) 

alaaif  (PLOPT  .aq.  '4')  than 
XTITLE-'TIME  (aaeonda)' 

XLEN— 15 

YTITLE-’ IMA  (ampa)' 


IV 


if  (ELEMNT  .aq.  1)  than 

PTITLE-’ MOTOR  PHASE  A  CURRENT  WITH  RELAY  CONTROLLER' 
PLEN-44. 

alsaif  (ELEMNT  . aq .  3)  than 

PTITLE-' MOTOR  PHASE  A  CURRENT  WITH  PWM  CONTROLLER’ 

PLEN-42. 

andif 

PTIT1-’ BRUSHLESS  DC  MOTOR' 

PLEN1-20. 

Data  RatriavaL  . . . 

if  (DRIVE  .aq.  ‘A’}  than 

open(5,fila-’a:BLDCM2.VIR’ ,status-'OLD' .accass- 'SEQUENTIAL' ) 
alsaif  (DRIVE  .aq.  'B' )  than 

opan(S, file-' b:BLDCM2. VIR' , status-’OLD' ,  access-' SEQUENTIAL' ) 
alsaif  (DRIVE  .aq.  'C')  than 

opan( 5 , file-' c : BLDCM2 . VIR' , status-' OLD* , accass- 'SEQUENTIAL ’ ) 
andif 

do  834  PCTR-l.NPTS 
raad( 3 , 934 )  IMA 
Y1(PCTR)-IMA 
continua 

format (I5X. FIS. 7) 
closa ( S , status- 'KEEP' ) 

call  GRAFHCXTIME.Yl.XaRG.YORG.DISOPT) 

alsaif  (PLOPT  .aq.  '5')  than 
XTITLE-'TIME  (saeonds)’ 

XLEN— 15 

YTITLE-’IMB  (amps)’ 

YLEN-U 

if  (ELEMNT  .aq.  I)  than 

PTITLE-' MOTOR  PHASE  B  CURRENT  WITH  RELAY  CONTROLLER' 
PLEN-44. 

alsaif  (ELEMNT  .aq.  3)  than 

PTITLE- 'MOTOR  PHASE  B  CURRENT  WITH  PWM  CONTROLLER' 

PLEN-42 . 
andif 

PTIT1-’ BRUSHLESS  DC  MOTOR' 

PLEN1-20. 

Data  Ratriaval  . . . 

if  (DRIVE  aq  'A')  than 

opan(5, fila-' a : BLDCM2  VIR’ , status- 'OLD' , accass- ' SEQUENTIAL ' ) 
alsaif  (DRIVE  aq.  * B *  >  than 

opan(S, f ila-’b : BLDCM2 . VIR’ , status- ‘OLD’ , accass- ' SEQUENTIAL ’ ) 
alsaif  (DRIVE  aq.  ’C’ >  than 

opan( 3, fila-’ e : BLDCM2  VIR’ , status- ’OLD' , accass- ’ SEQUENTIAL ’ ) 


read(5,935)  IMB 
Y1(PCTR)-IMB 
continue 

format ( 30X, F 15 . 7 ) 
c loaa ( 5 , a t atus- ' KEEP ' ) 

call  GRAPH (XT IME.Y1,X0RG,Y0RG,DIS0PT) 

alsalf  (PLOPT  . aq.  '6')  than 
XTITLE-'TIME  (aaconda)' 

XLEH— 15 

YTITLE-'IMC  (amps)' 

YLEN-11 

if  (ELEMNT  .aq.  1)  than 

PTITLE-'  MOTOR  PHASE  C  CURRENT  WITH  RELAY  CONTROLLER' 
PLEN-44. 

alsalf  (ELEMNT  .aq.  3)  than 

PTITLE-' MOTOR  PHASE  C  CURRENT  WITH  PWM  CONTROLLER' 

FLEN-42. 

andif 

PTIT1-' BRUSHLESS  DC  MOTOR' 

PLEN1-20 . 

Data  Retrieval  . . . 

if  (DRIVE  .aq.  ’A')  than 

open(5,file«'a:BLDCM2.VIR' . status- ’OLD’ . access-' SEQUENTIAL' ) 
aLaaif  (DRIVE  .aq.  ’*')  then 

opan(5.fila-’b:BLDCM2.VIR' , atatua-’OLD’ , access”’ SEQUENTIAL' ) 
alaaif  (DRIVE  .aq.  'C’>  than 

open(3 ,  file**’  c :  BLDCM2 .  VIR'  , status- 'OLD' ,  access- 'SEQUENTIAL' ) 
andif 

do  836  PCTR-l.NPTS 
read (5, 936)  IMC 
Y1(PCTR)“IMC 
continue 

format(43X,F15.7> 
c lose ( 5 , statua- ' KEEP ' ) 

call  GRAFH(XTIME, Yl.XORG, YORG.DISOFT) 

alaaif  (PLOPT  .aq.  '7')  than 
XTITLE-'TIME  (seconds)’ 

XLEN— 15 

YTITLE-’TM  (ox-in)' 

YLEN-11 

if  (ELMCT  .aq.  1)  then 

PTITLE- ' MOTOR  TORQUE  (ox-in)  WITH  RELAY  CONTROLLER' 

PLEN-43 . 

alaaif  (ELEMTT  .aq.  3)  than 

PTITLE- 'MOTOR  TORQUE  (ox-in)  WITH  PWM  CONTROLLER’ 


s  V 


FLEN-* 1 . 


•ndif 

PTIT1-’ BRUSHLESS  DC  MOTOR' 

FLEN1-20. 

C 

C  ...  Data  Retrieval  . . . 

if  (DRIVE  .aq.  'A')  than 

opan( S , file—’ a : BLDCM2 . VIR 1 , atatus-'OLD' , accaas-' SEQUENTIAL' ) 
eisaif  (DRIVE  .aq.  'B‘ )  than 

opan ( 5 , f i la" 1 b : BLDCM2 . VIR ' ,atatua-'OLD' , accaas-’ SEQUENTIAL' > 
alsaif  (DRIVE  .aq.  'C‘ )  than 

opan(5,fila-'c :BLDCM2. VIR’ , atatus-’OLD ’ , accaas-' SEQUENTIAL ’ ) 
andif 

do  837  PCTR-1 , NPTS 
read(5, 937)  TM 
Y1(FCTR)-TM 

837  continua 

937  format (60X.F15 . 7) 
cloaa ( 5 , status- ’KEEP ' ) 

C 

call  GRAPH (XTIME,Y1,XORG,YORG,DISOPT) 

C 

alsaif  (PLOPT  .aq.  ’8‘)  than 
XTITLE-'TIME  (saconds) ' 

XLEN— 15 

YTITLE-'TMF  (os-in)’ 

YLEN-12 

if  (ELEMNT  aq.  1)  t>an 

PTITLE-' FILTERED  MOTOR  TORQUE  (os-in)  WITH  RELAY  CONTROLLER’ 
PLEN-31 . 

alsaif  (ELEMNT  .aq.  3)  than 

PTITLE-' FILTERED  MOTOR  TORQUE  (os-in)  WITH  PWM  CONTROLLER’ 
PLEN-50. 
andif 

PTIT1-’ BRUSHLESS  DC  MOTOR’ 

PLEN1-20 . 

C 

C  ...  Data  Ratriaval  . . . 

if  (DRIVE  .aq.  'A')  then 

open(5,  file-’  a : BLDOS2 .  VIR’  .status- ’OLD’  ,  access- ‘SEQUENTIAL’  ) 
alsaif  (DRIVE  .aq.  ’B’)  than 

opan ( 5 , file— ’ b : BLDCM2 . VIR’ , atatus-'OLD' , accaas-’ SEQUENTIAL ’ ) 
alsaif  (DRIVE  .aq.  ’C’ )  than 

opan(S , file-' c :BLDCM2  VIR’ , atatus-'OLD’ . access- ’SEQUENTIAL’ ) 
andif 

do  838  PCTR-1, NPTS 
read(S, 938)  TMF 
Y1(PCTR)-TMF 

838  continua 

938  formatf  75X.F15 . 7) 
close! 5 , status-’KEEP’ ) 
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call  GRAPH (XT IME.Yl.XORG.YORG.DISOPT) 

alaaif  (PLOPT  .aq.  -9')  than 
XTITLE- ' TIME  (aaconda) ' 

XLEN— 15 

YTITLE-’VDID  (volta)' 

YLEN-13 

i£  (ELEMNT  .aq.  1)  than 

PTITLE-' POWER  TRANSISTOR  #1  VOLTAGE  DROP  (RELAY)' 

PLEN-41. 

alaaif  (ELEMNT  .aq.  3)  than 

PTITLE- ' POWER  TRANSISTOR  #1  VOLTAGE  DROP  (FWM)’ 

PLEN-39. 
and  it 

PTIT1-1 BRUSHLESS  DC  MOTOR' 

FLEN1-20 . 

Data  Ratriaval  . . . 

i f  ( DRIVE  . aq .  ' A ' )  than 

opan(6, fila-’a:BLDCM3.VIR' , atatua-'OLD' . accaaa-' SEQUENTIAL' ) 
alaaif  (DRIVE  .aq.  ’B’)  than 

opan(6,£ila-'b:BLDCM3.VIR’ .atatua-’OLD' , accaaa- 'SEQUENTIAL' ) 
alaaif  (DRIVE  .aq.  'C' )  than 

opan(6 , fila-' c : BLPCM3 . VIR' .atatua-'OLD' , accaaa— 'SEQUENTIAL' ) 
andif 

do  839  PCTR-1 ,NPTS 
raad(6,939)  VOID 
Y1(PCTR)«VD1D 
continua 
format (F15 . 7 ) 
cloaa(6, atatua-'KEEP’ ) 

call  GRAPH ( XT IME , Y1 , XORG, YQRG, DISOPT ) 

alaaif  (PLOPT  .aq.  ’10’)  than 
XTITLE-'TIME  (aaconda)' 

XLEN— 15 

YTITLE-'VD2D  (volta)’ 

YLEN-13 

if  (ELQ4TT  .aq.  1)  than 

PTITLE- ’ POWER  TRANSISTOR  #2  VOLTAGE  DROP  (RELAY)’ 

PLEH-41. 

alaaif  (ELD4TT  .aq.  3)  than 

PTITLE- ' POWER  TRANSISTOR  #2  VOLTAGE  DROP  (PWM)' 

PLEN-39. 

andif 

PTIT1-' BRUSHLESS  DC  MOTOR’ 

FLEN1-20 . 


Data  Ratriaval 


if  (DRIVE  .aq.  'A')  than 

opan ( 6 , f 1 la- * ■ : BLDCM3 . VIR ' , status- ' OLD ' , access-' SEQUENTIAL ' ) 
alsaif  (DRIVE  .aq.  'B')  than 

opant  6 , f ila— ' b : BLDCM3 . VIR’ , ststus-'OLD' , access-' SEQUENTIAL ’ } 
elssif  (DRIVE  .tq.  ’C' )  than 

opan(6.fila-’c:BLDCM3.VIR‘ , status-’OLD’ .accass- ’ SEQUENTIAL ’ ) 
and  if 

do  8*0  PCTR-l.NPTS 
raad (6 , 9*0 )  VD2D 
Y1(PCTR)-VD2D 
8*0  continua 

9*0  format( 13X . F15 . 7) 

c loss (6, status-’ KEEP’ ) 

C 

call  GRAPH ( XT IME.Yl , XORG, YORG.DISOPT) 

C 

alsaif  (PLOPT  .aq.  ’ll')  than 
XTITLE-’TIME  (saconds)’ 

XLEN— 15 

YTITLE-’ VD3D  (volts)’ 

YLEN-13 

if  (ELQfflT  .aq.  1)  than 

PTITLE-’ POWER  TRANSISTOR  #3  VOLTAGE  DROP  (RELAY)’ 

PLEN-* 1 . 

alsaif  (ELEME"  .aq.  3)  than 

PTITLE-’ POWER  TRANSISTOR  #3  VOLTAGE  DROP  (FWM)’ 

PLEN-39. 

andif 

PTIT1-’ BRUSHLESS  DC  MOTOR’ 

PLEN1-20. 

C 

C  ...  Data  Ratrisval  . . . 

if  (DRIVE  .aq.  ’A’)  than 

opan(6,fila-’a:BLDCM3 .VIR’ .status- ’OLD’ .accass-’ SEQUENTIAL’ ) 
alsaif  (DRIVE  .aq.  ’B’)  than 

opsn(6, fila-'b: BLDCM3  .VIR’  .status-’’ OLD’  .accass- ’SEQUENTIAL’  ) 
alsaif  (DRIVE  .aq.  ’O’)  than 

opan( 6 , file-’ c : BLDCM3 .VIR' , statua-’OLD’ , accass-' SEQUENTIAL’ ) 
andif 

do  8*1  PCTR-l.HPTS 
raad ( 6 ,9*1)  VD3D 
Y1(PCTR)-VD3D 
8*1  continua 

9*1  fonaat(30X,F15. 7) 

c loss (6, status- ’KEEP’ ) 

C 

call  GRAPH (XT IME , Y1 , XORG , YORG, DISOPT) 

C 

alsaif  (PLOPT  aq.  ’12’)  than 
XTITLE-’TIME  (saconds)’ 


YTITLE--VD4D  (volts)’ 

YLEN-13 

if  (ELEMNT  .  eq.  1)  then 

PTITLE-' POWER  T^SISTOR  #4  VOLTAGE  DROP  (RELAY)' 

PLEN-4 1 . 

elseif  (ELEMNT  .eq.  3)  then 

PTITLE- ' POWER  TRANSISTOR  #4  VOLTAGE  DROP  (PVM) ’ 

PLEN-39. 

•ndif 

PTIT 1“ ' BRUSHLESS  DC  MOTOR' 

PLEN1-20 . 

C 

C  ...  Data  Retriaval  . . , 

if  (DRIVE  .  eq.  ’A’)  then 

open ( 6 , file” ’ a : BLDCM3 . VIR ’ , atatus-'OLD’ , access-' SEQUENTIAL ' ) 
elseif  (DRIVE  .eq.  'B')  then 

open(6, file-'b : BLDCM3 . VIR’ , status-'OLD’ , access-’ SEQUENTIAL’ ) 
elseif  (DRIVE  .eq.  ’C’)  then 

open(6 , file-' e : BLDCM3 .VIR’ , status-’OLD’ , access- ’SEQUENTIAL’ ) 
endif 

do  842  PCTR-l.NPTS 
read( 6 , 942 )  VD4D 
Y1(PCTR)-VD4D 
842  continue 

942  format (45X, F15. 7 ) 

closet  6, status- ’KEEP’ ) 

C 

call  GRAPH (XT IME,Yl,XQRG,YQRG,DISOPT) 

C 

elseif  (PLOPT  .eq.  ’13’)  then 
XTITLE-’TIME  (seconds)’ 

XLEN— 15 

YTITLE-’VDSD  (volts)’ 

YLEN-13 

if  (ELEMNT  .eq.  1)  then 

PTITLE-’ POWER  TRANSISTOR  *5  VOLTAGE  DROP  (RELAY)’ 

FLEN-4 1 . 

elseif  (ELEMNT  .eq.  3)  then 

PTITLE- ’ POWER  TRANSISTOR  #5  VOLTAGE  DROP  (PWM)’ 

PLEN-39. 

endif 

PTIT1-’ BRUSHLESS  DC  MOTOR’ 

PLEN1-20 . 

C 

C  ...  Data  Retrieval  . . . 

if  (DRIVE  .eq.  ‘A’)  then 

open(6, file- ’ a : BLDCM3 .VIR’ , status-’OLD’ , access- ’ SEQUENTIAL ' ) 
elseif  (DRIVE  .eq.  ’B’)  then 

open(6 , file- ’ b : 8LDCM3 .VIR’ , status-’OLD’ , access-' SEQUENTIAL’ ) 
elseif  (DRIVE  .eq.  1 C ’ )  then 

open (6 , file—' c : BLDCM3 . VIR' , status-’OLD ’ , access-’ SEQUENTIAL ’ ) 
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// 


•ndif 


do  843  PCTR-l.NPTS 
read(6,943)  VD5D 
Y1(PCTR)-VD5D 

843  continue 

943  format (60X.F15. 7) 
closa(6, status-' KEEP’ ) 

C 

call  GRAPH  (XTIME ,  Y1 , XORG , YORG, DISOPT ) 

C 

elseif  (PLOPT  ,aq.  ’14*)  than 
XTITLE-’TIME  (seconds)’ 

XLEN— 15 

YTITLE- 'VD6D  (volts)’ 

YLEN-13 

if  (ELEMNT  .eq.  1)  then 

PTITLE-’ POWER  TRANSISTOR  #6  VOLTAGE  DROP  (RELAY)’ 

PLEN-41. 

elseif  (ELEMNT  .eq.  3)  then 

PTITLE-' POWER  TRANSISTOR  #6  VOLTAGE  DROP  (FWM) ’ 

PLEN-39. 
end  if 

PTIT1-' BRUSHLESS  DC  MOTOR’ 

PLEN1-20. 

C 

C  ...  Data  Retrieval  . . . 

'  if  (DRIVE  .eq.  ’A’)  then 

open ( 6 , file* ’ a : BLDCM3 . VIR ’ .status- ’OLD’ . access- ’ SEQUENTIAL’ ) 
elseif  (DRIVE  ,eq.  ’B’)  then 

open(6, file-' b :BLDCM3 .VIR' , status-’OLD’ . access- ’SEQUENTIAL’ ) 
elseif  (DRIVE  .eq.  ’C’)  then 

open(6, file-’ C.BLDCM3 . VIR’ , status-’OLD’ , access- ’SEQUENTIAL’ ) 
endif 

do  844  PCTR-1 , NPTS 
read( 8,944)  VD6D 
Y1(PCTR)-VD6D 

844  continue 

944  format ( 7 5X ,715 . 7 ) 
close(6 , status- 'KEEP' ) 

C 

call  GRAFH(XTIME,Y1, XORG, YORG, DISOPT) 

C 

elseif  (PLOPT  .eq.  ’15’)  then 
XTITLE-’TIME  (seconds)’ 

XLEN— 15 

YTITLE- 'NODE  0  VOLTAGE  (VDC)’ 

YLEN-21 

PTITLE- ’ CENTER  CONNECTION  VOLTAGE  RESPONSE’ 

PLEN-35 . 

PTIT1-' BRUSHLESS  DC  MOTOR’ 

PLEN1-20 . 


c 

c 

c 


Dumps  simulation  spscif iestions  to  printsr. 


subrout ins  PRNOUT ( BEGTIM . FINTIM , PTSPLT , MAXITS , SIM2PL , DELTIM , 

+  NTERMS , EO , EDOTO , TYPE , STPMAG , RSLOPE , SINAMP , SINFRQ, 

+  SINPHA, NLCHAR , DBAND , PERIOD , KPVM , RIN , ROUT , RDADJ , 

+  KTM, KBM,KV ,KF , RA, LA, BM, BL , JM , JL , RSAT , RCUT , TTIME , 

+  RS , THADV , TDPLUG ) 

implicit  REAL*!  (A-Z) 
integsr*2  SIM2PL , NTERMS 
charactsr*6  TYPE 
charactar*2S  NLCHAR 

. . .  Printsr  ready??  . . . 
call  CLRSCR 
call  GOTOXY (12,25) 

writa(*,*)  'Please  ensura  PRINTER  is  ready' 
call  GOTOXY (20 , 1) 

PAUSE 

. . .  Output  Simulation  Options  to  Printer  . . . 
open(8,  file”’  pm’  ,  status- ’new’ ) 

wr its ( B , 1600 )  BEGTIM , FINTIM , PTSPLT . MAXITS , SIM2PL . DELTIM . 
NTERMS, EO, EDOTO 

write(8, 1601)  TYPE , STPMAG, RSLOPE, SINAMP, SINFRQ, SINPHA, 
NLCHAR, DBAND, PERIOD, KFWM, RIN, ROUT, RDADJ  * 
writetB, 1602)  KTM,KBM,KV.KP,RA,LA,BM,BL. JM. JL.RSAT, 

RCUT , TTIME ,RS , THADV, TDPLUG 

write (8, 1603) 

1600  f onset (/,18X,’***  BRUSHLESS  DC  MOTOR  SIMULATION  SPECS  ***',/, 

+  1X,F15.7,1X, ' (BEGTIM]  Start  Time  of  Plotting  Window’,/, 

+  1X,F15.7,1X, * (FINTIM]  Stop  Time  of  Plotting  Window’,/, 

+  1X.F15. 7 , IX, ’ (PTSPLT]  Points  to  be  Plotted  per  Curve’,/, 

*  1X.F15. 7, IX, ’ (MAXITS]  Max  Number  of  Simulation  Iterations’,/, 

+  13X, 13 , IX,  ’ (SIM2PLJ  Ratio:  Points  Simulated/Plotted’,/, 

+  1X.F15.7, IX, * [DELTIM]  Simulation  Step  Sise  (seconds)’,/, 

+  10X, 16 , IX ,  ’[NTERMS]  Total  Number  of  Simulation  Steps’,/, 

+  IX , F15 . 7 , IX, ’ [E0 ]  Initial  Fin  Position  ERROR  (deg)’,/, 

+  1X.F15.7, IX, ’[EDOTO]  Initial  Fin  Velocity  ERROR  (deg/s)’,//) 

1601  format(25X,  ’**«  CCM1AND  INPUT  SELECTION  ***',/, 

+  1X.A15, IX,  ’[TYPE]  STEP,  RAMP,  or  SINE  Response’,/, 

+  1X.F15. 7 , IX, ’ [STPMAG]  Coamanded  Position  for  STEP  Response’,/, 
+  1X,F15.7,1X, ’ [RSLOPE]  Slope  of  RAMP  Function’,/, 

+  1X.F15.7.1X, ' (SINAMP]  Amplitude  of  SINE  Function’,/, 

+  1X.F15.7, IX, ’ [SINFRQ]  Frequency  (deg/sec)  of  SINE  Function’,/, 
+  IX , F15 . 7 , IX, ’ [SINPHA]  Phase  Angle  (deg)  of  SINE  Function’,//, 

+  27X , ’ ***  CONTROLLER  SELECTION  ***',/, 

+  10X, 'CONTROLLER  SELECTION  -->  ’,A30,/, 

*  IX, FIS. 7 , IX ,’ [DBAND]  Deadband  Applied  to  System  Feedback',/, 

+  1X.F15 . 7  ,  IX,  ’  [PERIOD]  Period  of  WM  Reference  Cycle(sec)  ’  ,  /  , 


+  IX. FIS. 7,  IX,  '  [KFtM]  PtH  Amplifier  Gain',/, 

+  IX, F15. 7, IX, ’ [RIN]  Currant  Limiting  Raaiatanca  (insida)'./, 

+  IX, FIS . 7 , IX, ' [ROUT]  Current  Limiting  Raaiatanca  (outside) ’ , / , 

+  IX  ,F15 , 7  ,  IX ,  ’  [RDADJ]  Series  R  Added  to  Freewheeling  Diodes’,//) 

1602  format (25X, ’***  MOTOR  PARAMETER  SELECTION  »»*’,/, 

+  1X.F15. 7 , IX, ’ [KTM]  Motor  Torque  Constant’,/, 

+  1X.F15.7, IX, ’ [KBM]  Motor  Back  EMF  Constant’,/, 

+  1X.F15 . 7 , IX, ’ [KV]  Motor  Velocity  Feedback  Constant’,/, 

+  IX, FIS . 7 , IX, ’ [KF]  Motor  Position  Feedback  Constant’,/, 

+  IX.F1S . 7 , IX, ’ [RA]  Motor  Phase  Resiatance(Ohm) ' , / , 

+  IX, FIS . 7 , IX, ' [LA]  Motor  Phase  Inductance(Benries) ’ , / , 

+  1X.F15. 7, IX, ’ [BM]  Motor  Viscous  Friction  Coeff’,/, 

+  1X.F15 . 7 , IX, ' [BL]  Load  Viscous  Friction  Coeff’,/, 

+  IX, FIS. 7, IX, ' [JM]  Hotor  Inertia (oz-in/s~2) ’ , / , 

+  1X.F15 . 7 , IX, ’ [ JL]  Load  Inertia(oz-in/a~2) ’ , / , 

+  1X.F15 . 7 , IX , 1 [RSAT]  Equiv  Ckt  Resistance  of  Trans  Satur',/, 

♦  1X.F15.7, IX, ‘ [RCUT]  Equiv  Ckt  Resistance  of  Trans  Cutoff’,/, 

+  1X.F15.7, IX, 1 [TTIME]  Transistor  Switching  Time',/, 

+  IX, FIS . 7 , IX , ' [RS ]  Internal  Resist  of  Supply  Voltage’,/, 

+  IX, FIS. 7, IX, ’ [THADV]  Commutation  Advance  (Electrical  Deg)’,/, 

+  1X.F15 . 7 , IX , ’ [TDPLUG]  Connotation  Dead  Time  while  Plugging',/) 

C 

1603  formatC  1’) 
close(8,status-’KEEP’ ) 

C 

return 

end 


C  BLDCM3A . FOR  (subroutines  GRAPH , MGRAPH , PWMOD . RELAY , 

C  COMADV , HALL ,  IXANSW .LIMIT, FCNSW , STEP , DEADSP , 

C  RAMP , TCONST , DERTV , INTGRL , CLRSCR , GOTOXY ) 

C  These  subroutines  must  be  compiled  as  a  group  separately  from 
C  BLDCM1  because  of  compiler  size  limitations.  BLDCM3A  must  be 

C  linked  to  BLDCM1  &  BLDCM2A  at  link  time. 

C 

C  Last  Revision  — >  OS  April  1S87 

C  LT  Vincent  S.  Rossitto,  USN 

C 

C  ***»•*«*•****••*****»***••*••**• 

C  *****  PLOTTING  SUBROUTINES  ***** 

C  *****(single  function  plot)***** 

C  *****•••*»****••*•*****•**•*»»*• 

Subroutine  GRAPH (X,Y,XORG,YORG,DISOPT) 

C 

implicit  REAL**  (A-Z) 


C08MON  BEGTIM , FINTIM , NPTS , IOPORT , MODEL , XLEN , YLEN , PLEN , PLEN1 , 
XTITLE , YTITLE , PTITLE , PTIT1 
real**  X(1010> ,Y(1010) 

integer*2  NPTS , IOPORT , MODEL , XLEN , YLEN , NCHAR , NCHAR1 
charaeter*3  DISOPT.ANS 
character*25  XTITLE, YTITLE 


charaetar*51  PTITLE, PTIT1 

Maka  a  naw  titla. . . 

5  call  CLRSCR 

if  ((DISOPT  aq.  'P')  or.  CDISOPT  aq  ’p'))  than 
call  GOTOXY (8,30) 
writa(*,*)  'Currant  Titla  la:’ 
call  GOTOXY (10,20) 
writa(* , * )  PTITLE 
call  GOTOXY (11,20) 
wnta(« ,  • )  PTIT1 
call  GOTOXY (15,25) 

writa( * . 1 (A\ ) ’ )  'Do  you  want  to  chanta  tha  titla?  • 
raad(* , ’ (A) ’ )  ANS 
call  CLRSCR 

if  (CANS  aq.  'Y’>  .or.  (ANS  .aq.  'y'))  than 
call  GOTOXY (S, 10) 

writa(V*)  'Entar  titlaa  in  laft  Juatifiad  format' 
call  GOTOXY (12, 10) 

writa(* . *)  ' 1231567890123*56789012315678901234567890123*567890 
call  GOTOXY ( 13 , 10 ) 

writa(*,*>  '  123*5 

call  GOTOXY (15,25) 
writa(*,*)  '#  of  charactara  --»• 
call  GOTQXY(20,10) 

writa(*,»)  ‘ 123*567890123*567890123*567890123*567890123*567890 
call  GOTOXY(21, 10) 

wrlta(*,*)  '  123*5 

call  GOTOXY (23. 25) 
writa(*,*)  '#  of  charactara 
call  GOTQXYdl,  11) 
raad(*. ’(A51)' )  PTITLE 
call  GOTOXY ( 15 . *6 ) 
raad(* , • )  PLEN 

call  GOTOXY ( 19, 11) 
raad(*. '  (A51V  )  PTIT1 
call  GOTOXY ( 23 , *6 ) 
raad(*. *)  PLEN1 

•laaif  ((ANS  .aq.  ’N*)  .or.  (ANS  .aq.  'n'))  than 
to  to  10 
andif 
to  to  5 
andif 

10  call  GOTOXY (10,25) 

writa(«,»)  'Calculatint  Plottint  Data' 

AS PRAT-  65 
CHARHT-  22 

PTX-  5+ ( 6  - PLEN* ASPRAT*CHARHT ) / 2 
PTY-1.5 


PTX1-. 5+(6. -PL£Nl*ASPRAT*CHARHT)/2. 

mw.i 

NCHAR-ifix(PLEN) 

NCHARl-ifixCPLENl) 

C 

call  PLOTS (O.IOPQRT, MODEL) 
call  FACTOR C 1.00) 
call  ASPECT (ASPRAT) 

C  .  .  .  Draw  a  Bordar 

if  ((DISOPT  .aq.  ’P‘)  or.  (DISOPT  .aq.  * p ' ) )  than 
call  PLOTtXORG , YORG, -13 ) 
call  PLOT (8.0,00,2) 
call  PLOT ( 8 . 0 , 6 . 0 , 2 ) 
call  PLOT ( 0 . 0 , 6 . 0 , 2 ) 
call  PLOT ( 0 . 0 , 0 . 0 , 2 ) 
and  if 
C 

C  call  SCALE (X, 6. ,NPTS,1> 
call  SCALEtY,*. ,NPTS,1) 
call  STAXIS(.1S, .22, .12, .080,3) 

C  ...  Thia  scaling  applias  whan  tha  X  axis  raprasants  Tima. . . 
X(NFTS+1)«B£GTIM 
FIRSTX  -  XCNPTS+1) 

X ( NPTS+2 ) - C X ( NPTS ) -X ( HPTS+ 1 ) ) / 6 . 

DELTAX  -  X(NPTS+2) 

FIRSTY  -  Y<NPTS+1) 

DELTAY  -  Y ( NPTS+2 ) 
call  PLOTU. 25.1.  ,-13) 

call  AX1S(0 .0,0. 0 .XTITLE , XLEN , 6 . , 0 . . FIRSTX . DELTAX ) 

call  STAXIS(.15, .22, .12, .080,2) 

call  AXISC0 . .0. .YTITLE.YLEH.*. ,80. .FIRSTY, DELTAY) 

call  SYMBOLt PTX. PTY , CHARBT , PTITLE, 0 . , NCHAR) 

call  SYMBOL (PTX1 , PTY 1 , CHARHT , PTIT1 , 0 . , NCHAR1 ) 

call  LINE(X.Y,NPTS, 1,0,0) 

call  PLOTCO. ,0. ,888) 

C 
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C 

c  *************************** 
c  *****  PLOTTING  SUBROUTINES 
C  *****  (nwlti -function  plot) 
c  •••*.•••••••••••••*••*•*.*• 


Subroutina  MGRAPH(X , Y . Z , XORG , YORG. DISOPT ) 

C 

implicit  REAL**  (A-Z) 

COPMON  BEGTIM , FINTIM , NPTS , IOPORT , MODEL , XLEN , YLEB , PLEN , PLEN 1 , 
*  XTITLE, YTITLE, PTITLE, PTIT1 


raal**  X(1010),Y(1010),Z(1010) 

intagar*2  NPTS , IOPORT, MODEL , XLEN , YLEN , NCHAR , NCHAR1 
charactar*3  D I SOPT , ANS 
charactar*25  XTITLE, YTITLE 
charaetar*51  PTITLE, PTIT1 

ASPRAT-.65 
CHARHT- . 22 
CHARH1-.20 

Mala  a  naw  titla. . . 
call  CLRSCR 

if  ((DISOPT  . aq.  ’P‘>  or.  (DISOPT  .aq.  ’p’))  than 
call  GOTOXY (8,30) 
writaf*,*)  ‘Currant  Titla  la:’ 
call  GOTOXY (10,20) 
writa(*,*)  PTITLE 
call  GOTOXY (11, 20) 
writa(*,«)  PTIT1 
call  GOTOXY (13,23) 

writa(»,  ‘  (A\ )‘  )  'Do  you  want  to  changa  tha  titla?  * 
raad(* , ‘ (A) ‘ )  ARS 
call  CLRSCR 

if  ( (ARS  .aq.  'Y‘)  .or.  (ARS  .aq.  ‘y’))  than 
call  GOTOXYtS.lO) 

writa(*,»)  ' Entar  titlaa  in  laft  Juatifiad  format’ 
call  GOTOXY (12,10) 

writa(*,*)  ’123*567890123*567880123*567890123*567890123*567690’ 
call  GOTOXY ( 13 , 10) 

writa(*,*)  ’  123*5’ 

call  GOTOXY(15,25) 
writa(*,*)  ’#  of  charactara  --»’ 
call  GOTOXY (20, 10) 

writa(*,»)  ’ 123*567890123*567890123*567890123*567890123*567890’ 
call  GOTOXY (21, 10) 

writa(*,*)  ’  123*5’ 

call  GOTQXY(23 , 25) 
writa(*,*)  ’#  of  charactara  — >’ 
call  GOTOXY (11,11) 
raad(», ’ { AS 1 ) ’ )  PTITLE 
call  GOTOXY ( 15 , *6 ) 
raad(*,*)  PLEN 

call  GOTOXY (19,11) 
raad(*, ’ (A51) ’ >  PTIT1 
call  GOTOXY (23 , *6 ) 
raad(* , * )  PLIK1 

alaaif  ((ARS  aq.  ’R’>  or.  (ANS  aq.  ’n’l)  than 
go  to  10 
and  if 
go  to  5 
and  if 


c 

10  call  GOTQXY (10,25) 

wnta(*,*)  'Calculating  Plotting  Data' 
u 

PTX- . 5+ (6 . -PLEN+ASPRAT+CHARHT )  /  2 . 

PTY-4 . 5 

PTX1-. 5+(6. -PLENl«ASPRAT*CHARHl)/2. 

PTYl-A.l 
NCHAR-i f ix( PLEN ) 

NCHARl-ifix(PLENl) 

C 

call  PLOTS ( 0, IOPORT, MODEL) 
call  FACTOR C 1.00) 
call  ASPECTt ASPRAT ) 

C  ...  Draw  a  Bordar  . . . 

if  ((DISOPT  aq  'P')  .or.  (DISOPT  .  aq.  'p'))  than 
call  PLOT (XORG , YORG , - 13 ) 
call  PLOT (60,0.0,2) 
call  PLOT (80,6.0,2) 
call  PLOT ( 0 . 0 , 6 . 0 , 2 ) 
call  PLOT ( 0 . 0 , 0 . 0 , 2 ) 
and  if 
C 
C 

C  ...  Thia  acaling  appliai  whan  tha  X  axis  rapraaanta  Tima 
X(NPTS+1)— BEGTIM 
FIRSTX  -  X(NPTS+1) 

X(NPTS+2)-(X(NPTS)-X(NPTS+l) )/6. 

DELTAX  -  X ( HPTS+2 ) 

C 

call  SCALE (Y, 1 . . NPTS , 1 ) 
call  SCALE ( Z , 1 . , HPTS . 1 ) 
if  ( Z C HPTS+2 )  .gt.  Y (HPTS+2) )  than 
Y ( HFTS+2 ) -Z ( NPTS+2 ) 

alaa 

Z( HPTS+2 )-Y(BPTS+2) 
and  if 

FIRSTY-Y(NPTS+1) 

DELTAY  -  Y( NPTS+2) 

C 

call  PLOT (1.23,1. ,-13) 

call  STAXXSt .15, .22, .12, .080,3) 

call  AXIS ( 0 .0,0.0, XTITLE ,XLEN , 6 . , 0 . , FIRSTX , DELTAX ) 
call  STAXIS(.1S, .22, .12, .080,2) 

call  AXIS{0 . 0,0.0, YTITLE , YLEH , 4 . , 90 . , FIRSTY , DELTAY) 

call  SYMBOL ( PTX, PTY,CHARHT,PTITLE,0. , NCHAR ) 

call  SYMBOLCPTXl , PTY1 , CHARB1 , PTIT1 , 0 . .NCHARl) 

call  LIHE<X,Y, HPTS, 1,0,0) 

call  CURVE (X , Z , HPTS , - . 1 ) 

call  PLOT(0. ,0. ,999) 

C 
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C 

rttum 

•nd 

C 

c  ..•*••««•«*«*«••**••»*****•.****»* 

c  *****  PULSE  width  modulator  module 


Subrout in#  PVHOD ( TIME , HUMIT , TSTART .PERIOD , TOGGLE , POSERR , 
♦  DBAND,  VIF,  VIB,  DIR,  VREF,  THRESH,  KPWM) 

IMPLICIT  REAL**  (A-Z) 

INTEGER*2  NUMIT.DIR 
LOGICAL*2  WAITNG, TOGGLE 


Rsast  th#  saw-tooth  nltrinci  signal  . 
if  (TIME  ga.  TSTART+PERIOD)  thsn 
TSTART-TSTART+PERIOD 
TOGGLE- . trus . 
sndlf 

if  (POSERR  .gt.  (O.+DBAND))  thsn 
DIR-1 

ERROR-sbs (KPWM* ( POSERR-DBAND ) ) 
slssif  (POSERR  .It.  (0. -DBAND))  thsn 
DIR— 1 

ERROR-sbs (KPWM* ( POSERR+DBAND ) ) 

slss 

ERROR-O. 
and  if 

call  LIMIT (0..1. ERROR, ERROR) 
call  RAMP (TIME, TSTART, RREF) 
VREF-NREF/ PERIOD 
THRESH- 1  -ERROR 


"WAITNG"  is  a  logical  variabls  indicating  whathar  or  not  a  naw 
pula#  say  ba  gsnaratsd 
if  (NUMIT  sq  1)  WAITNG-TOGGLE 

if  (WAITNG)  thsn 

if  (VREF  gt  THRESH!  thsn 
if  (DIR  sq  1)  thsn 
VIF-75 
VIB— 75 
TOGGLE-  f alas 
slssif  (DIR  sq  -1)  thsn 
VIF-75 
VIB—- 75 
TOGGLE-  f s las 


•ndif 


•leeif  (VREF  .It.  THRESH)  then 
VIF-0 . 

VIB-0 . 

TOGGLE- . true . 

■ndif 

•ndif 

C 

return 

•nd 

C 

c  *•*•*.******•»•»•******* 

c  *****  relay  module  ***** 

c 

c 

Subroutine  RELAY ( POSERR , DBAND , VIF , VIB , DIR) 
C 

implicit  REAL**  (A-Z) 
integer*2  DIR 

C 

if  (FOSERR  gt.  DBAND)  then 
VIF-75. 

VIB— 75. 

DIR-1 

•Leeif  (FOSERR  .It.  -DBAND)  then 
VIF-75. 

VIB— 75. 

DIR— 1 

•leeif  (ebe(POSERR)  .le.  DBAND)  then 
VIF-0. 

VIB-0 . 

■ndif 

C 

return 

•nd 

C 

C  •*••*••**•*•••**•*•********•«••*»*****«*•* 
C  *****  Commutation  Advance  Subroutine  ***** 


Subroutine  COMAEV ( THETA . PI , THADV , THCON . THRST ) 
implicit  REAL**  (A-Z) 

THD EG— THETA* ( 1 80 . 0 / PI ) 

THRST-AMOD ( THDEG , 3 60 . 0 ) 

if  (THRST  . LT.  0.0)  TERST-THRST+360. 

TBCON-THRST+THADV 

return 

•nd 


C 


Hell  Seneor  Poeltioning  Subroutine 


c 


Subroutine  HALL<THC0N,SE1,SE2,SE3> 
implicit  REAL**  (A-Z) 
if  (THCON  ga  180.0)  THCON-THCON-180 . 
if  ((THCON  .ga.  0.0)  .and.  (THCON  .It.  30.0))  go  to  10 

if  ((THCON  .ga.  30.0)  .and.  (THCON  .It.  60.0))  go  to  11 

if  ((THCON  .ga.  60.0)  .and.  (THCON  .It.  90.0))  go  to  12 

if  ((THCON  .ga.  90.0)  .and.  (THCON  .It.  120.0))  go  to  13 

if  ((THCON  .ga.  120.0)  .and.  (THCON  .It.  150.0))  go  to  1* 

if  ((THCON  .ga.  150.0)  .and.  (THCON  .It.  180.0))  go  to  15 

10  SE1-1. 

SE2-0 . 

SE3-1 . 
go  to  20 

11  SEW. 

SE2-0 . 

SE3-0 . 
go  to  20 

12  SEW. 

SE2-1. 

SE3-0 . 
go  to  20 

13  SE1-0. 

SE2-1. 

SE3-0 . 
go  to  20 

14  SE1-0. 

SE2-1. 

SE3-1 . 
go  to  20 

15  SE1-0. 

SE2-0 . 

SE3-1 . 

20  continue 

C 

return 

and 

C  ****************************************** 

C  *****  General  Comnutation  Subroutine  ***** 

C  ****************************************** 

Subrout ina  TRAHSW C TIME , REVTIM , BEMFA , BEMFB , BEMFC . BEMFT , VEMEA , 
VEMFB , VHdFC , VIB , VIF , IM, IMA , IMB , IMC , VN1 , VN2 , SW1 , 
SW2 , SW3 , SW* , SW5 , SW6 , THCON , THCON1 , RSAT .POSIT , DIR , 
VD ID , VD2D , VD3D , VD4D , VD5D , VD6D , RIN , ROUT , RS , 

REQA1 , REQA2 , REQB1 , REQB2 , REQC1 .REQC2 , IAB , IBC , 

ICA ,  PVAO ,  PVBO ,  PVCO ,  NODE  ,  TRIG1 ,  TRIG2  ,  TRIG3  , 

TRIG*, TRIG5.TRIG6.RA. PLUG, VAIND.VBIND.VCIND) 
implicit  REAL**  (A-Z) 

integer*2  POSIT , DIR , TRIG1 , TRIG2 , TRIG3 , TRIG* , TRIG5 , TRIG6 . PLUG 
C 

THCON l“amod( THCON ,180.0) 
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if  (THC0N1  .it.  0.0)  THCON1-THCON1+180. 


IM-( abs ( IMA)+aba ( IMB )+abs  CMC) ) /2 . 


if  (TRIG1  .  aq.  1)  than 

PVAOX-abs(VAIND)+IMA*(RA+RIN/2. ) 
alsaif  (TRIG2  aq.  1)  than 

FVAOX—  abs(VAIND)+IMA*(RA+RIN/2.  ) 

aisa 

PVAOX-VAIND+IMA*(RA+RIN/2. ) 
andif 

if  (TRIG3  .aq.  1)  than 

PVBOX-aba(VBIND)+IMB*(RA+RIN/2. ) 
alsaif  (TRIG*  .aq.  1)  than 

PVBOX—  aba(VBIND)+IMB*(RA+RIN/2. ) 

alaa 

FVBOX-VBIND+IMB*(RA+RIN/2. ) 
andif 

if  (TRIG5  aq.  1)  than 

PVCOX-ab* ( VCIND )+IMC* (RA+RIN/2 . ) 
aiaaif  (TRIG6  .aq.  1)  than 

PVCOX— ab»(VCIND)+IMC*(RA+RIN/2.  ) 

alaa 

PVCOX-VCISD^IMC«(RA+RIN/2.  ) 
andif 


if  ((DIR  .aq.  1)  .and.  (PLUG  aq.  0))  than 


if 

( ( THCON 1  .ga 

0,0)  . 

and. 

(THCOKl  .It. 

30.0))  POSIT-1 

if 

( ( THCON 1  .ga 

30.0) 

.  and . 

( THCON 1  .It. 

60.0))  POSIT-2 

if 

( ( THCON 1  .ga 

60.0) 

.and. 

( THCON 1  .It. 

90.0))  POSIT-3 

if 

( ( THCON 1  ga 

90.0) 

.and. 

( THCON 1  .It. 

120.0))  POSIT-* 

if 

( ( THCON 1  ga 

120.0) 

.  and 

.  (THCON1  .It 

.  150.0))  POSIT-5 

if 

( ( THCON 1  .ga 

150.0) 

.  and 

.  ( THCON 1  .It 

.  180.0))  POSIT-6 

Laalf  ((DIR  .aq. 

- 1 )  . and .  ( PLUG  . aq .  0 ) ) 

than 

if 

( ( THCON 1  .ga. 

0.0)  . 

and . 

{ THCON 1  .It. 

30.0))  POSIT-* 

if 

( ( THCON 1  ga. 

30.0) 

.  and. 

( THCON 1  .It. 

60.0))  POSIT-5 

if 

( ( THCON 1  ga. 

60.0) 

.  and . 

( THCON 1  .It. 

90  0))  POSIT-6 

if 

( ( THCON 1  ga 

90.0) 

.  and . 

( THCON 1  .It. 

120.0))  POSIT-1 

if 

( ( THCON 1  .ga. 

120.0) 

.  and 

.  ( THCON 1  .It 

.  150.0))  POSIT-2 

if  ((THCON1  ga.  150.0 
andif 

if  (POSIT  aq.  1)  than 


150.0)  .and.  (THCON1  .It.  180.0))  POSIT-3 


(  NODE  ia  tha  WYE  cantar  point  floating  voltaga  ) 
NODE— ( PVCOX+PVBOX  >+float  ( DIR  )*(  VIJffC -VEMFB ) 
i f  ( PLUG  . aq .  0 )  than 
SW1-0 
SW2-0. 

SW3-0 . 


BEMFT-BEMFC-BEMFB 

VN1-VIF-VEMFC 

VN2-VIB-VEMFB 

VD ID- ( VI F - IM* ( RS+ROUT ) / 2  ) - ( FVAOX+VEMFA+NODE ) 
if  (VOID  .la.  -.6)  TRIG1  -  1 

VD2D- ( FVAOX+VEMFA+NODE ) - (VIB+IM* ( RS+ROUT ) 12.) 
if  (VD2D  .la.  -.6)  TRIG2  -  1 

VD3D-( VIF-IM* (RS+ROUT ) /2 . > - ( PVBOX+VEMFB+NODE ) 
if  ( VD3D  .la.  -.6)  TRIG3  -  1 

VD*D—  IMB*REQB2 

if  (VD4D  .la.  -.6)  TRIG!  -  1 

VD5D-OC+REQC1 

if  (VD5D  .la.  -.6)  TRIGS  -  1 

VD6D-( PVCOX+VEMFC+NODE ) - (VIB+IM* (RS+ROUT ) /2 . ) 
if  (VD6D  .la.  -.6)  TRIG6  -  1 

alaaif  (PLUG  . aq.  1)  thro 
SW1-0. 

SH2-0. 

SW3-0. 

SW+-1. 

SW5-0. 

SW6-0. 

IAB-0. 

IBC-0. 

ICA-O. 

BEMFT-BOffT-BEMFB 

VN1-VIF-VEMFC 

VN2“VIB-VEMFB 

VD ID- ( VIF - IM* (RS+ROUT ) / 2 . ) - ( FVAOX+VEMFA+NODE ) 
if  (VOID  .!•.  -.6)  TRIGI  -  1 


VD2D-(FVAOX+VEMFA+NODE)- (VIB+IM* (RS+ROUT) /2. > 
if  (VD2D  .!•.  -.6)  TRIG2  -  1 


VD3D-( VIF-IM* (RS+ROUT ) / 2 . ) - ( PVBOX+VBffB+NODE ) 
if  ( VD3D  la.  -.6)  TRIG3  -  1 


c 

VD*D- ( PVB0X+VEMF8+N0DE )  - (VIB+IM*  (RS+ROUT  )/2.) 
if  (VD*D  .le.  -.6)  TRIG*  -  1 
C 

VD5D- ( VIF- IM* ( RS+ROUT ) /2 . ) - ( PVCOX+VEMFC+NODE ) 
if  (VDSD  .le.  -.6)  TRIGS  -  1 
C 

VDSD- ( PVCOX+VEMFC+NODE ) - (VIB+IM* (RS+ROUT ) /2 . ) 
if  (VDSD  . 1*.  -.6)  TRIG6  -  1 
C 

•ndif 

C 

elseif  (POSIT  .  eq.  2)  then 
C 

NODE—  ( PVAOX+ PVBOX  )  +  float(DIR>»(  VEMFB  -  VEMF  A ) 
if  (PLUG  .  eq.  0)  then 
SW1-1. 

SW2-0  . 

SW3-0 . 

SW*~1. 

SW5-0. 

SW6-0. 

c 

IBC-0 . 

ICA-0 . 

BEMFT-BEMFA-BEMFB 
VN1-VIF-VEMFA 
VN2-VIB- VEMFB 

C 

VD1D-IMA*REQA1 
if  ( VD1D  .le.  -.6)  TRIG1  -  1 
C 

VD2D- ( FVAOX+VEMFA+NODE )  -  ( VIB+IM*  (RS+ROUT  )/2.) 
if  (VD2D  .Le.  -.6)  TRIG2  -  1 
C 

VD3D- ( VIF- IM* (RS+ROUT ) /2 . > - ( FVBOX+VEMFB+NODE ) 
if  (VD3D  .le.  - .6)  TRIG3  -  1 
C 

VD*D—  IMB*REQB2 
if  (VD*D  .le.  -.6)  TRIG*  -  1 
C 

VD 5D- ( VIF- IM*  (RS+ROUT  )  / 2  .  ) -  ( PVCOX+VEMFC+NODE ) 
if  (VDSD  .le.  -.6)  TRIG5  -  1 
C 

VD6D-( PVCOX+VEMFC+NODE)- (VIB+IM* (RS+ROUT )/2. ) 
if  (VD6D  .le.  -.6)  TRIG6  -  1 
C 

elseif  (PLUG  .eq.  1)  then 
SWI-0  . 

SW2-0 . 

SW3-0  . 
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SW4-1. 
SW5-0 . 
SM6-0 . 


IAB-O. 

IBC-0 . 

ICA-0 . 

BEMFT-BEMFA-BEMFB 

VN1-VIF-VEMFA 

VN2-VIB-VEMFB 


VD ID- <  VIF - IM* ( RS+ROUT )  / 2 .  ) -  ( FVAOX+ VEMF A+NODE ) 
if  (VD1D  .le.  -.6)  TRIG1  -  1 


VD2D- ( FVAOX+VEMFA+NODE )  -  (VIB+IM* (RS+ROUT ) 12.) 
if  (VD2D  .le.  -.6)  TRIG2  -  1 


VD  3D- ( VIF - IM* ( RS+ROUT ) / 2 . ) - ( FVBOX+VEMFB+NODE ) 
if  (VD3D  .le.  -.6)  TRIG3  -  1 


VD4D- (FVBOX+VEMFB+NODE)- (VIB+IM*  (RS+ROUT)  /2 .  ) 
if  (VD4D  .le.  -.6)  TRIG*.  -  1 


VD5D- ( VIF-IM* (RS+ROUT ) /2 . ) - ( FVCOX+VEMFC+NODE ) 
if  (VD5D  .le.  -.6)  TRIGS  -  1 


VD6D- ( PVCOX+VEMFC+NODE ) - (VIB+IM* (RS+ROUT ) /2 . ) 
if  (VD6D  .le.  -.6)  TRIGS  -  1 


endif 


elseif  (POSIT  .eq.  3)  then 


NODE— ( FVAOX+PVCOX  )+floet  (DIR)*  (VEMFA-VEMFC ) 
if  (PLUG  .eq.  0)  then 
SW1-1. 

SW2-0 . 

SW3-0 . 

SH4-0. 

SW5-0. 

SW6-1. 

IAB-0. 

IBC-0. 

BEMFT-B£MFA-BEMfC 

VN1-VIF-VEMFA 

VN2-VIB-VEMFC 


VD1D-IMA+REQA1 

if  (VOID  .le.  -.6)  TRIG1  -  1 


VD2D-( PVAOX+VEMF A+NODE ) - (VIB+IM* (RS+ROUT ) / 2  ) 
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A*V  *. 


v 


if  (VD2D  . 1*.  -.6)  TRIG2  -  1 


C 


c 


c 


c 


c 


c 


c 


c 


c 


c 


c 


c 

c 

c 


VD3D“(VIF-IM* (RS+ROUT) /2 . ) - ( FVBOX+VEMFB+NODE ) 
if  (VD3D  .  le.  -.6)  TRIG3  -  1 

VD*D-( FVBOX+ tfEMFB+NODE ) - (VIB+IM* (RS+ROUT  > /2 . ) 
if  (VD*D  .  Le.  -.6)  TRIG*  -  1 

VD5D- <  VIF- IM* ( RS+ROUT )  /  2 . )  -  ( FVCOX+VEMFC+NODE ) 
if  (VD5D  .le.  -.6)  TRIG5  -  1 

VD6D— IMC+REQC2 

if  (VD6D  . ie .  -.6)  TRIG6  -  1 


elseif  (PLUG  .  eq,  1)  then 
SW1-Q. 

SW2-0 . 

SW3-0 . 

SW*-0  . 

SW5-0. 

SW6-1. 

IAB-0. 

IBC-0 . 

ICA-0 . 

BEMFT-BEMFA-BEMFC 

VN1-VIF-VEMFA 

VH2-VIB-VEMFC 

VD1D-(VIF-IM* (RS+ROUT ) /2 . ) - ( FVAOX+VEMFA+NODE ) 
if  (VD1D  .le.  -.6)  TRIG1  -  1 

VD2D-  (  FVAOX+VEMFA+NODE )  -  (VIB+IM*  (RS+ROUT )  /  2 . ) 
if  (VD2D  .le.  -.6)  TRIG2  -  1 

VD3D- ( VIF -IM* ( RS+ROUT ) / 2 . ) - ( FVBOX+VFMFB+NODE ) 
if  (VD3D  .le.  -.6)  TRIG3  -  1 

VD*D-( FVBOX+VEMFB+NODE ) - (VIB+IM* (RS+ROUT )  /2 .  > 
if  (VD*D  .le.  -.6)  TRIG*  -  1 

VD  5D- { VI F - IM* ( RS +ROUT ) / 2 . ) - ( FVCOX+VEMFC+NODE ) 
if  (VD5D  .le.  -.6)  TRIG5  -  1 

VD6D- ( FVCOX+VEMFC+NODE ) - ( VIB+IM* (RS+ROUT ) / 2 . ) 
if  (VD6D  .le.  -.6)  TRIG6  -  1 

endif 

elseif  (POSIT  . eq.  *)  then 
NODE— ( PVBOX+ PVCOX ) + f  lo  e  t  ( D IR ) » ( VEMFC  -  VEMFB ) 


if  (PLUG  .  aq.  0)  than 
SW1-0 . 

SW2-0 . 

SW3-1. 

SW4-0 . 

SW5-0  . 

SW6-1. 

IAB-0 . 

ICA-0 . 

BEMFT-BiMFB-BEMFC 

VN1-VIF-VEMFB 

VN2-VIB-VEMFC 

VD  ID-  ( VI F  -  IM*  ( RS+ROUT ) / 2 . ) - ( PVAOX+VEMFA+NODE ) 
if  (VOID  .la.  -.6)  TRIG1  -  1 

VD2D— ( PVAOX+VEMFA+NODE > - (VIB+IM* (RS+ROUT )/2.) 
if  (VD2D  .la.  -  6)  TRIG2  -  1 

VD3D— IMB*REQB1 

if  (VD3D  .la.  -  6)  TRIG3  -  1 

VD*D-(PVBaX+VEMFB+N0DE>-(VIB+IM*(RS+R0UT>/2. ) 
if  (VD4D  .la.  -.6)  TRIG*  -  1 

VD 5D“( VI F-IM* (RS+ROUT ) 12. ) - ( PVCOX+VEMFC+NODE ) 
if  (VD5D  .la.  -.6)  TRIGS  -  1 

VD6D-- IMC+REQC2 

if  (VD6D  .la.  -.6)  TRIGS  -  1 

alaaif  (PLUG  .  aq.  I)  than 
SW1-0 . 

SW2-0. 

SW3-0. 

SW4-0 . 

SW5— 0 . 

SW6-1 . 

IAB-0. 

IBC-0 . 

ICA-0. 

BEMFT-BEKFB-BEMFC 
VN1-VIF-VIMFB 
VN  2-VI B -  VDfFC 

VD ID- ( VIF - IM* (RS+ROUT ) / 2 . ) - ( PVAOX+VEMFA+NODE ) 
if  (VD1D  .la.  -.6)  TRIG1  -  1 

VD2D- ( PVAOX+VEMFA+NODE ) * ( VIB+IM* (RS+ROUT ) /2 . ) 
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il  (VO 2D  .la.  -.6)  TRIG2  -  1 


VD3D- (VIF- IM* (RS+ROUT ) / 2 . ) - ( FVBOX+VEMFB+NODE ) 
if  (VD3D  .la.  -.6)  TRIG3  -  1 

VD*D«( FVBOX+VEMFB+NODE ) - (VIB+IM* (RS+ROUT ) /2 . ) 
if  (VD*0  .la.  - .6)  TRIG*  -  1 

VD  3D- ( VIF - IM* (RS+ROUT ) / 2 . ) - ( FVCOX+VEMFC+NODE ) 
if  (VDSD  .la.  -.6)  TRIGS  -  1 

VD6D- ( FVCOX+VEMFC+NODE ) - ( VI B+ IM* ( RS+ROUT ) / 2 . ) 
if  (VD6D  .la.  -.6)  TRIG6  -  1 

and  if 

elaaif  (POSIT  . aq .  5)  than 

NODE— ( FVBOX+FVAOX  )+float(  DIR  )*  (VQ1FB-VQ1FA) 
if  (PLUG  .aq.  0)  than 
SW1-0 . 

SW2-1. 

SW3-1. 

SWi-0. 

SW3-0 . 

SW6-0. 

IBC-0. 

ICA-0 . 

BEMFT-BEMFB-BEMFA 

VN1-VIF-VEMFB 

VN2-VIB-VEMFA 

VDlD-(VIF-IM*(RS+ROUT)/2.)-( FVAOX+VEMFA+NODE ) 
if  (VOID  .la.  -.6)  TRIG1  -  I 

VD2D—  IMA*RE0A2 

if  (VD2D  .la.  -.6)  TRIG2  -  1 

VD3D-IMB*REQB1 

if  (VD3D  .la.  -.6)  TRIG3  -  1 

VD*D-( FVBOX+VEMFB+NODE )- (VIB+IM* (RS+ROUT ) /2 . > 
if  (VOID  .la.  -.6)  TRIG*  -  1 

VD  5D- ( VIF - IM* ( RS+ROUT ) / 2 . ) - ( PVCOX+VTKFC+NODE ) 
if  (VDSD  .la.  -.6)  TRIG5  -  1 

VD6D- ( FVCOX+VEMFC+NODE ) - (VIB+IM* (RS+ROUT ) 12.) 
if  (VD6D  ,1a.  -.6)  TRIGS  -  1 


aliaif  (PLUG  aq  1)  then 
SW1-0 . 

SW2-1 

SW3-0 

SW*-0 

SW5-0 

SW6-0 

IAB-0 

IBC-O. 

ICA-0 . 

BEMFT-BEMFB- BEMFA 

VN1-VIF-VEMFB 

VN2-VIB-VEMFA 

VD ID- ( VIF - IM* ( RS +ROUT ) / 2 . ) - ( PVAOX+VEMFA+NODE  > 
If  (VOID  .1*.  -.6)  TRIG1  -  1 

VD2D-  ( PVAOX+VEMFA+NODE  ) - ( VI B+ IM*  < RS+ROUT )  /  2  .  ) 
if  ( VD2D  .la.  '  6)  TRIG2  -  1 

VD3D-  ( VIF  -  IM*  (RS+ROUT )  /  2  .  )  -  ( PVBOX+VEMFB+NODE ) 
if  (VD3D  . la.  -.6)  TRIG3  -  1 

VD<.D-(FVBOX+VEMFB+NODE)-(VIB+IM*(RS+ROUT)/2.  ) 
if  (VD4D  .la.  -.6)  TRIG*  -  1 

VDSO- ( VIF-IM+  (RS+ROUT ) / 2 . ) - ( PVCOX+VEMFC+NODE ) 
if  (VD5D  .1*.  -.6)  TRIGS  -  1 

VD6D-  ( PVCOX+VEMFC+NODE )  -  ( VIB+ IM*  ( RS+ROUT )  /  2 .  ) 
if  (VD6D  la.  -.6)  TRIGS  -  1 

•ndif 

alsaif  (POSIT  . aq .  6)  than 

NODE—  ( PVCOX+PVAOX  )+f  loat  ( DIR )  *  ( VIMFA-VEMFC ) 
if  (PLUG  .aq.  0)  than 
SW1-0 . 

SW2-1. 

SW3-0. 

SW4-0 . 

SW5-1. 

SW6-0. 

IAB-0. 

IBC-0. 

BEMFT-BEMFC -BEMFA 

VN1-VIF-VIMFC 

VN2-VIB-VEMFA 


TO  ID-  ( VI F  -  IM*  <  RS+ROUT  )/2  )  -  (  FVAOX+VEMFA+NODE  ) 
it  (TO ID  la  -  6)  TRIG1  -  1 

r 

TO2D— IMA*REQA2 
If  (TO2D  1*  -  6)  TRIG2  -  1 

C 

TO3D- ( VIF - IM* ( RS+ROUT  >  /  2  .  >  -  ( PVBOX+VB4FB+HODE ) 
If  (TO3D  .la  -  6)  TRIG3  -  1 

TOAD- ( PVBOX+VEMFB+NODE ) - ( VIB+IM* (RS+ROUT ) / 2  ) 
if  (TOAD  .La  -  6)  TRIG*  -  1 

C 

TO5D-IMC*REQC1 

if  (TO5D  la  -6)  TRIGS  -  1 

TO6D-  ( PVCOX+VEMFC+NODE  )  -  ( VI B+  IM*  ( RS+ROUT  )  /  2  > 
if  ( TO6D  la.  -6)  TRIG6  -  1 
C 

alaaif  (PLUG  aq  1)  than 
SW1-0 
SW2-1. 

SW3-0 

SWA-0. 

SWS-0. 

SW6-0 . 

c 

IAB-O. 

IBC-0. 

ICA-0. 

BEMFT-BEMFC - BEMFA 

VN1-VIF-VEMFC 

VN2-VIB-VEMFA 

C 

TO  ID-  ( VIF  -  IM*  ( RS+ROUT )  /  2  .  >  -  ( PVAOX  +VEMF A+NODE ) 
if  (VOID  .la.  -.6)  TRIG1  -  1 
C 

TO2D-  ( PVBOX+VEMFB+NODE ) - ( VIB+ IM* ( RS+ROUT )  /  2 .  ) 
if  (TO2D  ,1a.  -.6)  TRIG2  -  1 
C 

TO3D- ( VIF- IM*  (RS+ROUT >  /  2 .  )  -  ( PVBOX+VEMFB+NODE ) 
if  (TO3D  .la.  -.6)  TRIG3  -  1 
C 

VDAD—( PVBOX+VEMFB+NODE ) - (VIB+IM* (RS+ROUT )/2.) 
if  (TOAD  .la.  -.6)  TRIGA  -  1 
C 

TO5D-(VIF-IM* (RS+ROUT }/2. )-( PVCOX+VIMFC+NODE) 
if  (TOSD  la.  -.6)  TRIGS  -  1 
C 

TO6D— ( FVCOX+VEMFC+NODE ) - (VIB+IM* (RS+ROUT ) /2 . ) 
if  (TO6D  .la.  -.6)  TRIG6  -  1 
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•ndif 


99 


•ndif 

continue 

return 

end 


Cutoff-Seturetion  Limiting  Subroutine 


Subroutine  LIMIT(RSAT , RCUT , INPUT , OUT ) 
implicit  REAL**  (A-Z) 
if  (INPUT  . le.  RSAT )  then 
OUT-RSAT 

•leeif  (INPUT  ,ge.  RCUT)  then 
OUT-RCUT 

•  Lee 

OUT-INPUT 
end  if 


return 

end 


Function  Switch  Subroutine 


Subroutine  FCNSWCX1 ,X2 ,X3 .X* ,OUT) 
implicit  REAL*!  (A'Z) 
if  (XI  .It.  0.0)  then 
OUT-X2 

•leeif  (XI  eq.  0.0)  then 
OUT— X3 

•  lee 

oirr-x* 

end  if 


return 

end 


Step  function  Subroutine 


Subroutine  STEP (TIME.TSTEP, OUT) 
implicit  REAL**  (A-Z) 
if  (TIME  ge.  TSTEF )  then 
OUT-1 . 0 

•  lee 

OUT-O . 0 
end  if 
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•nd 


C  *****  Daadapaca  Subroutina  ***** 

C 

Subroutina  DEADSPt  PI , P2 . VSGDEL , VSGERR) 
implicit  REAL**  (A"Z) 
if  (VSGDEL  gt.  P2 )  than 
VSGERR” VSGDEL -  P2 
alaaif  (VSGDEL  .It.  PI)  than 
VSGERR-VSGDEL-P1 
alaa 

VSGERR-0 . 0 
and  if 
C 

ratum 

and 

C 

C  *****  R*nip  Subroutina  ***** 

C  **a*a***a***aa*aaaaaaaaaaaa 

Subroutina  RAMP ( T IME , TRAMP . OUT ) 
implicit  REAL**  (A-Z) 
if  (TIME  .ga.  TRAMP)  than 
OUT-TIME -TRAMP 
alaa 
OUT-O . 0 
and  if 
C 

raturn 

and 

C  ..................... 

C  «**  TIME  CONSTANT  *** 

c  ..................... 

c 

Subroutina  TCONST ( YO .X , TAU , NTIME , NTIM , DELTIM , Y ) 
implicit  raal**  (A-Z) 
intagar*2  NT IME, NT IM 
if  (NT IME  aq.  1)  Y-YO 
if  (NT IME  .na.  NTIM)  YO-Y 
DECAY-axp( -DELTIM/TAU) 

Y-Y0+ (X- YO ) * (1 . -DECAY ) 
if  (NT IME  .aq.  1)  Y-YO 
NTIM-NTXME 
C 

ratum 

and 


C  .••.•...•••••••».*.*..«.»**.»»»**.*****i 

C  .....  Firat  Ordar  Darivativa  Subroutina 

C  .....  (Cantral  Diffaranca  Mathod) 


Subroutina  DERIV(DELTIM, NT IME , NTIM1 , IC2 , XM1 , NOWVAL , XX , XDM1 , 
XD.XDDM1.XDD, SLOPE) 
implicit  REAL**  (A-Z) 
intagar‘2  NTIME.NTIMl 
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if  (NTIME  eq  NTIMl)  then 
XX-NOWVAL 


xx-nowvai 


XDDM1-XDD 


XD-(XX-XM1)/DELTIM 

if  (ebstXD)  It  l.E-8)  XD-0 

if  (NTIME  eq  1)  XD-IC2 

XDD“(XD-XDM1)/DELTIM 

if  ( abs (XDD )  It  l.E-8)  XDD-0 . 0 


NTIM1-NTIME 


XPR£D-XX-*-XD*DELTIM*XDD*(DELTIM**2) /2  0 
If  (abi(XPRED)  It.  1  E-8)  XPRED-0  0 
SLOPE-rXPRED-XMl )  /  (2  0*DELTIM) 
if  ( abs ( SLOPE )  It.  l.E-8)  SLOPE-O  0 


***  Trapezoidal  Integration  Subroutine 


Subroutine  INTGRL (NTIME . NTIM2 , DELTIM , IC3 . PREVAL . NOWVAL . 
CURVAL . OUTOLD . OUT NEW ) 
implicit  REAL**  (A-Z) 
mteger*2  NTIME. NTIM2 

if  ((NTIME  eq.  NTIM2)  or  (NTIME  eq  1))  then 
CURVAL-NOWVAL 


PREVAL  -  CURVAL 
CURVAL  -  NOWVAL 


OUTOL D  -  OUTNEW 


if  (NTIME  eq  1)  OUTOLD-IC3 

OUTNEW  -  OUTOLD* ( CURVAL*  PREVAL ) *DELTIM/ 2 . 

NTIM2-NTIME 


CLEAR  SCREEN  AND  HOME  CURSOR 


subroutine  CLRSCR 
chsrecter*!  C1.C2.C3.C* 


intagar*2  IC ( 4  ) 

aquivalanca  (Cl,  IC(  1) ) .  (C2.  IC(2) ) ,  (C3  .  ICO  ) ) ,  (C4  ,  XC<4  ) ) 
data  IC/16#1B,16#5B,16#32.16#4A/ 


APPENDIX  B 

PWM  OPEN  LOOP  TRANSFER  CHARACTERISTICS 


SNOf loatcalls 

SNOdebug 

C 


C  |  ROSSITTO,  VS  THESIS  PROF  GERBA  01/11/87  | 

C  | _ PWM  TEST  MODULE _ I 

C 

C  This  version  tasts  tha  pulse  width  modulator  for  logical 

C  correctness.  POSER?,  is  used  as  an  input  and  VIN  is  the 

C  output . 

IMPLICIT  REAL**  (A-Z) 

COt-MON  BEGTIM,  FINTIM,  NPTS  ,  IOPORT  .MODEL  ,  XLEN ,  YLEN  .  PLEN .  PPLANE  , 

+  xtitle.ytitle.ptitle 

REAL**  X( 1010 ), Yl( 1010 ), Y2( 1010 ).Y3( 1010 ).Y* {1010 ) ,LINE0( 1010) 
INTEGER*2  NTERMS , IOPORT ,  MODEL , XLEN , YLEN , NTIME, NUMIT , NTIM1 , 

+  NTIM2 ,NTIM3 , NTIM* , DIR, PMODEL ,NPTS , NCTR , PPLANE , 

♦  SIM2PL ,  WAVE 

LOGICaL*2  WAITNG , TOGGLE 
CHARACTER* 1  DISOPT , PLOPT 
CHARACTER'S  ANSI ,ANS11 ,ANS21 , PRTSEL 
CHARACTER*20  XTITLE, YTITLE 
CHARACTER* 51  PRTCHR, PTITLE 
C 

C  ...  Introductory  Page  (1  time  good  deal!) 
call  CLRSCR 
write(*,*) 

PAUSE 

C  *************************************** 

C  ***  OPEN/READ/CLOSE  INPUT  DATA  FILE  *** 

C  *************************************** 

C 

13  open ( 7 , FILE-1 PWM. INP' ,STATUS-'OLD' .ACCESS- 'SEQUENTIAL' ) 

read (7, 1000)  FMODEL , PRTCHR 
read! 7 , 1020 )  BEGTIM , FINTIM , MAXITS , SIM2PL 
read (7. 1022)  DBAND, PERIOD 
raad( 7 , 102S )  KPWM , X0 , Y0 ,WFACT 
close (7, STATUS- 'KEEP' ) 

C 

c 

C  **»  DISPLAY  MAIN  MENU  SELECTIONS  »** 

c 

1  call  CLRSCR 

call  GCTOXY (10,1) 
write!*, 5) 
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readt*, ’ (A) ' )  ANSI 
C  ...  Hardware  Options  . . . 

if  ((ANSI  .  eq.  'h')  .or.  (ANSI  .aq.  ' H ’ ) )  than 
C 

101  caLl  CLRSCR 

call  GOTOXY (17,21) 

writet*. *)’***  CURRENT  PRINTER  SELECTION  ***’ 
call  GOTOXY (20,20) 
write(* , * )  FRTCHR 
call  GOTOXY (10,1) 
writet*, 105) 
read(* , • (A)' )  ANS11 
C 

C  ...  Printer  Options  . . . 

if  ( ( ANS11  .  aq.  'p')  .or.  (ANS11  ,eq.  'P'))  then 
131  call  CLRSCR 

write(* , 130 ) 

read( * , ’ (A)' )  PRTSEL 
C 

if  (PRTSEL  .aq.  '0')  than 

FRTCHR-' Epson  FX-80  Printer,  single  density' 

PMODEL-O 

alseif  (PRTSEL  .eq.  '1')  then 

PRTCHR-,Epson  FX-80  Printer,  double  density’ 

PMODEL-1 

elseif  (PRTSEL  .eq,  '2')  then 

PRTCHR-,Epaon  FX-80  Printer,  dble  spd.dual  density’ 
PMODEL-2 

elseif  (PRTSEL  .eq.  '3')  then 

PRTCHR-,Epson  FX-80  Printer,  quad  density’ 

PMODEL-3 

elseif  (PRTSEL  .eq.  ’*’)  then 

PRTCHR-'Epson  FX-80  Printer,  CRT  Graphics  I’ 

PM0DEL-* 

elseif  (PRTSEL  .eq.  ’5’)  then 

PRTCHR-’ Epson  FX-80  Printer,  plotter  graphics’ 
PMODEL-5 

elseif  (PRTSEL  .eq.  ’6’)  then 

PRTCHR-’Epson  FX-80  Printer,  CRT  Graphics  II’ 
PMODEL-6 

alseif  (PRTSEL  .eq.  ’10’)  then 

PRTCHR- ’ Epson  FX-100  Printer,  single  density' 
PWODEL-7 

elseif  (PRTSEL  .eq.  ’ll')  then 

PRTCHR-’ Epson  FX-100  Printer,  double  density’ 
PMODEL-11 

elseif  (PRTSEL  .eq.  ’12')  then 

PRTCHR-' Epson  FX-100  Printer,  dble  spd.dual  density’ 
MODEL- 12 

elseif  (PRTSEL  .eq.  ’13’)  then 

PRTCHR-'Epson  FX-100  Printer,  quad  density’ 
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PMODEL-13 


elsaif  (FRTSEL  .  aq.  '1*')  than 

PRTCHR-'Epson  FX-100  Pnntar.  CRT  Graphics  I' 
PMODEL-1* 

alaaif  (FRTSEL  .aq.  '15’)  than 

FRTCHR- ' Epion  FX-100  Printar,  plotter  graphics' 
PM3DEL-15 

elsaif  (FRTSEL  .aq.  '16')  than 

PRTCHR-'Epson  FX-100  Printer,  CRT  Graphics  II' 
PMODEL-16 

elsaif  (FRTSEL  .aq.  '20')  than 

FRTCHR” 'HP  7470A  Graphics  Plotter’ 

PMODEL-20 

elsaif  (PRTSEL  .aq.  '30')  than 

PRTCHR-'HP  7175A  Graphics  Plotter' 

FMODEL-30 

elsaif  (PRTSEL  .aq.  ’60’)  than 

PRTCHR-’HP  26S6A  Laser  Jat  Printer' 

PMODEL-60 

C 

C  ...  Quit  the  Printar  Menu  . 

elsaif  ((PRTSEL  aq.  'Q' )  .or.  (PRTSEL  .aq.  'q'))  than 
go  to  101 

alia 

go  to  131 
endif 
go  to  101 

C 

C  ...  Quit  the  Hardware  Menu  . . . 

alaaif ( (ANS11  .aq.  ’q')  .or.  (ANS11  .aq.  'Q'))  than 
go  to  1 

alia 

go  to  101 
endif 

C 

C  ...  PVH  Design  Menu  . . . 

alaaif  ((ANSI  .aq.  'p' )  or.  (ANSI  .aq.  'P'))  than 

C 

203  call  CLRSCR 

wrlta(* .250 )  KFWM , DB AND , PERIOD 
read<*. ’ (A)' )  ANS21 

C 

if  (ANS21  .aq.  'KPWM' )  than 
call  GOTOXY ( 2* , 1 ) 

writa(* , ' (A) ) ' ) ‘Enter  a  REAL  value  for  KFWM--»  1 
read ( * , • )  KFWM 
go  to  203 

alaaif  ( ANS21  .aq.  'PERIOD')  than 
call  GOTOXY ( 2* , 1 ) 

writa(* (A\ )') 'Enter  a  REAL  value  for  PERIOD--*  ’ 
read(* , • )  PERIOD 
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go  to  203 

elseif  (ANS21  .  eq.  'DBAND')  then 
call  GOTOXY ( 2i  ,1) 

wnte(*  ,’ (A\ )')' Enter  a  REAL  value  for  DBAND-->  1 
read( * , * )  DBAND 
go  to  203 
C 

C  . . .  Quit  PVM  Design  Menu  . . , 

elseif  (ANS21  .eq.  'Q‘ )  then 
go  to  1 

else 

go  to  203 
end  if 
C 

C  .  Simulation  Options  . . . 

elseif  ((ANSI  .eq.  'o')  .or.  (ANSI  .eq.  '0'))  then 
C 

202  call  CLRSCX 
C 

DELTIM-(FINTIM-B£GTIM)/(1000  *SIM2FL> 
if  (FINTIM/DELTIM  .gt.  MAXITS)  DELTIM  -FINTIM/MAXITS 
NTERMS-IFIX(FINTIM/DELTIM)  +  1 
C 

write(*,240)  BEGUM, FINTIM, MAXITS , SIM2PL , 

+  X0,Y0,WFACT,  DELTIM,  NTERMS 

read( * , • (A) ’ )  ANS21 

C 

if  (ANS21  .eq.  ’BEGTIM’)  then 
call  GOTOXY (24,1) 

*rite(* , ’ (A\ ) ’ ) ’ Enter  a  REAL  value  for  BEGTIM- ->  ' 
read( * , *)  BEGTIM 
go  to  202 

elseif  (ANS21  .eq.  'FINTIM')  then 
call  GOTOXY (2* , 1 ) 

write(*, ’ (A\ )') 'Enter  a  REAL  value  for  FINTIM-->  ’ 
read ( * , * )  FINTIM 
go  to  202 

eiaeif  ( ANS21  .eq.  'MAXITS')  then 
call  GOTOXY (2<t ,  1) 

write(* , * (A\ ) * ) 'Enter  a  REAL  value  for  MAXITS-->  * 
read( * , * )  MAXITS 
go  to  202 

elseif  (ANS21  .eq.  ' SIM2PL * )  then 
call  GOTOXY ( 2 A , 1 ) 

writet*, ‘ (A) )' ) 'Enter  a  INTEGER  value  for  SIM2PL--> 
reedt*.*)  SIM2FL 
go  to  202 

elseif  (ANS21  .eq.  'X0')  then 
call  GOTOXY ( 2i , 1 ) 

write(*, ' ( A \ )’) 'Enter  a  REAL  value  for  X0--»  ' 
reed ( * , * )  XO 
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go  to  202 

elseif  (ANS21  .eq.  *Y0'>  then 
call  GOTOXY (24 , 1) 

write(* , 1 (A\ )’) ’Enter  a  REAL  value  for  Y0-->  1 
read(*,*)  Y0 
go  to  202 

elseif  ( ANS21  .eq.  ' WFACT ’ )  then 
call  GOTOXY (24,1) 

write(* , ' (A\ ) ’ ) ’ Enter  a  REAL  value  for  WFACT-->  ' 
read( * , * )  WFACT 
go  to  202 

C  ...  Quit  Simulation  Options  Menu  . . . 

elseif  (ANS21  .eq.  ’Q‘ )  then 
go  to  1 

else 

go  to  202 
end  if 
C 

C  ...  Input  Waveform  Options  . . . 

elseif  ( (ANSI  .eq.  ‘i’)  or.  (ANSI  eq.  ’I'))  then 
C 

204  call  CLRSCR 
C 
C 


writef* , 260 ) 
readt* , ’ (A) ’ )  ANS21 
call  CLRSCR 

if  (ANS21  .eq.  ’1’)  then 
call  GOTOXY (10,1) 
WAVE-1 


writeC*, ’ (A\ )’) 'Enter  a  REAL  value  for  K — >  ' 
read(*,»)  CONST 

write(*, ’ <A\ ) ' ) ’  Enter  a  REAL  value  for  W-->  ' 

read(*,*)  W 

call  GOTOXY (17,4) 

write(*,141)  CONST, W 

141  format (IX, 'POSERR  ,F8.3, '*  SIN( • . F8 . 3 . *  *  t) ’ ) 

PAUSE 
go  to  204 

elseif  (ANS21  .eq.  '2')  then 
call  GOTOXY (10,1) 

WAVE-2 

wrlte(*, ’ (A\ )’) 'Enter  a  REAL  value  for  K — >  ' 
read(*,»)  CONST 

write!*, ' ( A \ )') '  Enter  a  REAL  value  for  W--»  1 
read(*,*)  W 

write(», • (A\ ) ’ ) '  Enter  a  REAL  value  for  TAU--> 
read( * , * )  TAU 
call  GOTOXY (17,4) 
write!* , 142)  CONST ,TAU,W 
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142  format  (IX,  'POSERR  -\F8.3,'*  EXP( -t/ '  ,  F8 . 4  ,  '  )*SIN( '  ,  F6 . 3  ,  1  *  t)') 

PAUSE 
go  to  204 

elsaif  (ANS21  .eq.  '3')  than 
call  GOTOXY (10,1) 

WAVE-3 

writat*, ’ (A\ ) ' ) 'Entar  a  REAL  valua  for  A-->  ' 
raad(*,*)  A 

writat*, ' (A\ )') ’  Entar  a  REAL  valua  for  B — >  ’ 

readt*,*)  B 

call  GOTOXY (17, 4) 

writat*, 143)  A,B 

143  f ormat ( IX ,' POSERR  -',F8.3,'*  t  +’,F8.4) 

PAUSE 
go  to  204 

C  ...  Quit  Simulation  Options  f  >nu  . . . 

alsaif  (ANS21  .aq.  'Q')  than 
go  to  1 

alsa 

go  to  204 
and  if 

C  ...  Sava  Options  to  Fila  . . . 

elsaif  ((ANSI  .aq.  's‘)  or.  (ANSI  .aq.  ’S’))  than 
C 

C  .*.*..*..«***»•********•**.*..*•***»*•*» 

C  ***  OPEN/WRITE/CLOSE  INPUT  DATA  FILE  *** 

C 

C 

open ( 7 . FILE- ‘ PWM . INP  * , STATUS- ' NEW ’ ) 

writat 7, 1000)  FMODEL , FRTCHR 

writat 7, 1020)  BEGTIM, FINTIM.MAXITS , SIM2PL 

writa(7 , 1022)  DBAND, PERIOD 

writa(7 , 1028)  KPWM.X0, Y0,WFACT 

write (7 , 2000 ) 

close (7, STATUS- 'KEEP' ) 

C 

go  to  1 
C 

C  ...  Run  the  Program  . . . 

elsaif  ((ANSI  .aq.  'r')  .or.  (ANSI  .eq.  'R'))  than 
go  to  2 
C 

C  ...  Quit  the  Program  . . . 

elsaif  ((ANSI  .aq.  'q')  .or.  (ANSI  .eq.  'Q’))  then 
stop 

else 

go  to  1 
andif 
C 

2  PI-3,14159 

C 
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C  ...  Initializations  . . . 


TSTART-0 . 0 


TOGGLE* . true . 


P PLANE* 0 


Display  the  simulation  header  . . . 

call  CLRSCR 

call  GOTOXY (10,29) 

write(*,*)  ’Simulation  in  Progress’ 

DELTIM*  (FINTIM-BEGTIM) / ( 1000 . *SIM2PL) 

if  (PINTIM/DELTIM  .gt.  MAXITS)  DELTIM  -FINTIM/MAXITS 

NTERMS-IFIX(FINTIM/DELTIM)+1 

call  GOTOXY (14,1) 

write  (* , 15)  DELTIM, NTERMS 

formate 16X Simulation  Step  Size  — >  ',F8.7,'  seconds',/, 
+  17X, ‘Total  Number  of  Steps — »  ’,1*) 

SPACE-DELTIM/2.0 


.  Open/Write/Close  OUTPUT  data  file  . . . 
open ( * , FILE- ' PWM . OUT ’ , STATUS- ’ NEW ’ > 

wr i te ( * , 1200 )  BEGTIM , FINTIM , MAXITS , SIM2PL , PERIOD , DBAND , 
+  ERRCUT , AGCCUT , ERRSAT , AGCSAT 

closet* , STATUS* ’ KEEP ’ ) 


START  MAIN  SIMULATION  LOOP  *** 


DO  100  NTIME-1 ,  NTERMS 


TIME-tNTIME-l )*DELTIM 


Reset  the  saw-tooth  referance  signal  . . . 
if  (TIME  .ge.  TSTART+FERIOD )  then 
TSTART-TSTART+PERIOD 


TOGGLE* . true . 


if  (WAVE  .eq.  1)  POSERR-CONST*SIH(W*TIME) 

if  (WAVE  .eq.  2)  POSERRK:ONST*exp(-TIME/TAU)*SIN(W*TIME) 

if  (WAVE  .eq.  3)  POSERR-A*TIME+B 


if  (POSERR  .gt.  (0.+DBAND))  then 


ERROR-abs (KFWM* ( POSERR-DBAND ) > 


elseif  (POSERR  .It.  (0. -DBAND))  then 


ERROR-abs (KPWM*  t  POSERR+DBAND ) ) 


ERROR- 0  . 


call  LIMIT(0. , 1. .ERROR, ERROR) 
call  RAMP ( TIME, TSTART.NREF) 

VREF-NREF/ PERIOD 
THRESH-1 . -ERROR 
C 

C  ...  "WAITING"  ia  a  logical  variable  indicating  whether  or  not  a  new 
C  pulse  may  be  generated  . . . 

WAITNG-TOGGLE 

C 

if  (WAITNG)  then 

if  (VREF  .gt.  THRESH)  then 
if  (DIR  .eq.  1)  then 
VIN-150 . 

TOGGLE-. false, 
elseif  (DIR  .eq.  -1)  then 
VIN— 150. 

TOGGLE- . false . 
end  if 
else 
VIN-0 . 

TOGGLE- . true . 
end  if 
end  if 
C 

DIRLOG— VIN/ 150 . 

C 

C  ...  Generate  Plotting  Arrays  . . . 
if  (TIME  .ge.  BEGTIM)  then 
NCTR-NCTR+1 

if  (mod (NCTR, SIM2PL )  .eq.  0)  then 
NPTS-NPTS+1 
X(NPTS)-TIME 
Y 1  ( NPTS ) -POSERR 
Y2 ( NPTS ) -VREF 
Y3 (NPTS) -THRESH 
Y* (NPTS) -DIRLOG 
LINE0(NPTS)-0 . 
endif 
end  if 
C 

100  CONTINUE 
C 

C  **•**•****•••***•*•***«•*****.*. 

C  ***  END  MAIN  SIMULATION  LOOP  *** 

C 

C 

C  ***•*••••**••*•*•*.***•**••••* 

C  *****  Plotting  selection  ***** 

C  •*••***•••••****•••»*»•••***•* 

C 

C  ***  Clear  Screen  &  Home  Cursor  *** 
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*00  call  CLRSCR 


KV. 


writa(*. 1305) 
read(* , ' (A) ' )  DISOPT 


if  (DISOPT  . eq  ’l’)  than 
MODEL-99 
IOPORT-99 

aLaaif  (DISOPT  ,aq.  '2')  than 
MODEL-PMODEL 
IOPORT-1 

if  ((MODEL  .  eq.  20)  .or.  (MODEL  ,aq.  30))  IOPORT-9600 
else  if  (DISOPT  .aq.  '3')  then 
GO  TO  13 

elseif  ((DISOPT  ,eq.  ’Q')  .or.  (DISOPT  .eq.  'q'))  than 
GO  TO  *60 

else 

write(*,»)  'Incorrect  display  option  selection,  try  again  !' 
go  to  *00 
and  if 


*10 


call  CLRSCR 

if  (DISOPT  aq.  '2')  than 
call  GOTCKY(20 , 20 ) 
write/*, •)  FRTCHR 
call  GOTQXY (1.1) 
and  if 

write(* , 1300) 
raad(* , ' (A) ’ )  PLOPT 


if  ( ( PLOPT  . aq .  ' Q ' )  . or •  ( PLOPT  . aq .  ' q ’ ) )  than 
go  to  *00 

aLsaif  (PLOPT  aq.  ’l’>  than 
XTITLE-'TIME  (sac)’ 

XLEN— 10 

YTITLE-'PWM  PERFORMANCE' 

YLEN-1* 

PPLANE-0 

call  MGRAPH(X.Y1,Y2, Y3,Y*,LINE0, DISOPT, KPWM , DBAND , X0 , Y0 , WFACT ) 

alsa 

go  to  *10 
and  if 


*60 


go  to  *00 
continua 


I/O  FORMAT  STATEMENTS 


*  format///// ,2*X, 'PULSE  WIDTH  MODULATOR  DESIGN  AND  ANALYSIS’,/, 
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+  26X,’.Open  Loop  Response  Characteristics',/, 

+  26X, ' .Automatic  Gain  Control  Simulation',/, 

+  26X,‘ .INTEL-8087  Math  Co-procaasor  veraion' .III , 

+  1 OX, 'NOTE:  Much  of  tha  acraan  control  attainad  in  thia  ',/, 

+  10X, 1  program  ia  interactive  with  tha  DOS  acraan  driver’./, 

+  10X,'  ANSI. SYS.  Enaura  your  CONFIG.SYS  file  containa',/. 

+  10X,'  tha  atatamant  device-ANSI . SYS" . * , / / , 

+  10X, ’  Tha  input  data  file  PVM.INP  must  be  in  the  ',/, 

+  10X, '  default  diak  drive.  Tha  output  file  PVM.OUT’,/, 

+  10X, 1  will  be  written  to  tha  default  drive.',//) 

5  format(32X, '***  MAIN  MENU  ***’.//, 

♦  20X,’[HJ - >  HARDWARE  Configuration  Menu',/, 

+  20X,'[P! - >  PWM  Daaign  Menu' ,/, 

♦  20X, ’ t I ] - >  INPUT  Waveform',/, 

♦  20X , ' [0] - >  OPTIONS  for  Simulation',/, 

♦  20X , ' [ S] - >  SAVE  All  Changes ’,/ , 

+  20X,'(R]-- — >  RUN  Simulation  Program’,/, 

+  20X , ' [Q] - >  QUIT  tha  Program',//, 

+  8X, 'ENTER  SELECTION - »',\) 

105  format ( 30X , ' ***  HARDWARE  MENU  •**’,//, 

+  20X, ' [P! - >  PRINTER/ PLOTTER  configuration  change',/, 

♦  20X,  '  [Q] - >  QUIT  THIS  MENU’ , //, 

♦  8X . ' ENTER  SELECTION - >■ , \ ) 

1000  format (IX, 13, 2X.A50) 

1020  format( lx, 3F12 . 7 , IX, 13 ) 

1022  format ( IX , 2F12 . 7 ) 

1028  formate IX, . 4F12.7) 

2000  format ( IX, 'END  OF  FILE') 

130  FORMAT ! 2*X, PRINTER  OPTIONS  MENU  ***',//, 

+  15X, ' [ 0 ]  -->  Epson  FX-80  Printer,  single  density’,/, 

+  15X,‘[1]  --»  Epson  FX-80  Printer,  double  density',/, 

♦  15X,’[2)  — >  Epson  FX-80  Printer,  dble  spd.dual  density’,/, 

+  15X,'[3]  -->  Epson  FX-80  Printer,  quad  density',/, 

+  15X,'[*]  -■>  Epson  FX-80  Printer,  CRT  Graphics  I’,/, 

+  15X,'[5]  — >  Epson  FX-80  Printer,  plotter  graphics',/, 

+  15X,'(61  -->  Epson  FX-80  Printer,  CRT  Graphics  II*,/, 

♦  15X,'(10]  ->  Epson  FX-100  Printer,  single  denaity',/, 

♦  15X,’[11)  -»  Epson  FX-100  Printer,  double  density',/, 

+  15X,’[12)  ->  Epson  FX-100  Printer,  dble  spd.dual  density',/, 

+  15X,'[13]  ->  Epson  FX-100  Printer,  quad  density',/, 

+  15X,'[14]  -»  Epson  FX-100  Printer,  CRT  Graphics  I’,/, 

+  13X,’(15]  ->  Epson  FX-100  Printer,  plotter  graphics’,/, 

+  15X , ’ (16]  -»  Epson  FX-100  Printer,  CRT  Graphics  II’,/. 

+  13X , ' [20 ]  ->  HP  7*70A  Graphics  Plotter',/, 

+  15X, ’ [30]  ->  HP  7*75A  Graphics  Plotter’,/, 

+  15X, ' [60]  ->  HP  2686A  Laser  Jet  Printer  (NPS  installation)’,/, 

+  15X , ’ [Q]  -->  QUIT  THIS  MENU' ,//, 

+  3X, 'Enter  Printer  Selection  Integer  or  Q  to  QUIT  - >  ’,\) 


i*'. 

L*.V, 


i&:>: 
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240  format ( 12X , ’ ***  SIMULATION  OPTIONS  MENU  ***',//, 

+  1X.F12 . 7 ,  IX, ' [BEGTIM]  Start  Tima  of  Plotting  Window',/, 

+  IX , F12 . 7 , IX , ' [ FINTIM]  Stop  Tima  of  Plotting  Window',/, 

♦  IX , F12 . 7 , IX , ' (MAXITS ]  Max  Number  of  Simulation  Iterations', 
+  10X ,  13  ,  IX,  *  [SIM2PL]  Ratio-.  Points  Simulated/Plotted',/, 

+  1X.F12. 7 , IX, ' [XO]  X  Coordinate  for  Plotting  Origin',/, 

♦  1X.F12. 7 , IX, ’ [Y0]  Y  Coordinate  for  Plotting  Origin1,/, 

+  1X.F12.7.1X. • [WFACT1  Plotting  Scaling  Factor',/, 

+  14X,'(Q]  QUIT  THIS  MENU',///, 

+  15X ,' Computed  simulation  step  size  >  ',F8.7,  'seconds',/, 

♦  15X, ’Computed  total  number  of  steps >  ',14,//, 

♦  IX, ’Enter  variable  name  (UPPERCASE)  or  Q  to  QUIT  - >  ’,\) 

250  formate/// ,23X, ’***  FWM  DESIGN  MENU  **•’,//, 

+  IX, F12 . 7 , IX , ' [KPWM]  PWM  Amplifier  Gain’ ,/, 

+  1X.F12. 7, IX, ’ [DBAND]  PWM  Amplifier  Deadband’,/, 

+  1X,F12.7,1X.’ [PERIOD)  Period  of  PWM  Reference  Cycle’,/, 
+1*X,’[Q]  QUIT  THIS  MENU’,//, 

+  IX, ’Enter  variable  name  (UPPERCASE)  or  Q  to  QUIT  - >  ’ , \ ) 


260  formate / / / , 13X , ' 
+  10X, ’ [1] 


+  10X, ’ [2]  POSERR-K*exp< 
+  10X, ’ [3]  POSERR-A*t+B ’ 
+  10X, ' [Q]  QUIT  THIS  ME* 
+  IX, 'Enter  [1.2.Q]  — »  ’,\) 


’***  INPUT  WAVEFORM  OPTIONS  MENU  * 
POSERR-K*iin(W*t) ’ ,/. 
POSERR“K*exp(-t/TAU)*sin(W*t) ’ ,/, 
POSERR-A*t+B ’ , / , 

QUIT  THIS  MENU’,//, 


1200  format (20X, ’PULSE  WIDTH  MODULATOR  ANALYSIS’,//, 

+  IX. F12 . 7 , IX, ’ [BEGTIM]  Start  Time  of  Plotting  Window’,/, 

+  IX, F12 . 7 , IX, ’ [FINTIM]  Stop  Time  of  Plotting  Window’,/, 

+  IX , F12 . 7 , IX , ' [MAXITS]  Max  Number  of  Simulation  Iterations’,/ 
+  10X, 13 , IX, ’ [SIM2PL]  Ratio:  Points  Simulated/Plotted’,/, 

+  1X.F12  7, IX. ' [PERIOD]  Period  of  PWM  Reference  Cycle’,/, 

*  IX , F12 . 7 , IX, ’ [DBAND J  Position  Feedback  Deadband',/, 

+  1X.F12.7.1X, ’ [KPWM]  PWM  Amplifier  Gain’) 

1205  FORMAT (IX, F8. 6, IX, IPSE 12. 3) 

1300  FORMATC///// ,2X, 'The  following  are  plotting  options’,//, 

+  5X,’[1)  WM  Performance',/. 

+  5X,’[Q]  QUIT  THIS  MENU'.//, 

*  2X, ’Enter  selection  [ 1 , QJ  >  ’,\) 

1305  FORMAT(/////,2X, ’Display  options:’,/, 

+  SX, ’ [1]  MONITOR’ ,/. 

*  5X, ’ 12]  PRINTER’,/, 

+  5X , ’ [ 3 ]  RETURN  TO  START-UP  MENU  (RE-INITIALIZE ) ' . / , 

+  5X,'[Q]  QUIT  THE  PROGRAM’,//, 

+  2X, 'Enter  selection  [1,2,3,Q]  - >  ’,)) 


1500  formate  IX , 13 , 2X , A50 ) 
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STOP 
END 

C . - . . 

c 

c  *****  PLOTTING  subroutines 
C  ****«(single  function  plot) 

C  *************************** 

Subroutine  GRAFH(X,Y) 

C 

implicit  REAL**  (A-Z) 

CCmON  BEGTIM ,  FINTIM ,  NPTS ,  IOPORT , MODEL , XLEN ,  YLEN ,  PLEN ,  PPLANE , 
♦  XTITLE , YTITLE , PTITLE 

real**  X( 10 10 ) , Y( 1010 ) 

integer*2  NPTS , IOPORT , MODEL , XLEN , YLEN , PPLANE , NCHAR 
character*20  XTITLE , YTITLE 
charecter*51  PTITLE 
C 

AS PRAT-. 65 
CHARBT- . 22 

PTX-1 . 5+{ 6 . -PLEN»ASPRAT*CHARHT )  /2 . 

PTY-5 . 5 

NCHAR-ifix(PLEN) 

C 

call  PLOTS (0, IOPORT, MODEL) 

call  FACTOR(l.OO) 

call  ASPECT(ASPRAT) 

call  SCALE (X, 6 . ,NPTS , 1) 

call  SCALECY,*. ,NPTS,1) 

call  STAXIS (.15, .22, .10, .060, 3) 

FIRSTX  -  X  CNPTS+1 ) 
if  (PPLANE  .eq.  1)  then 
DELTAX-X ( NPTS+2 ) 
else 

X(NPTS+2)-(X(NPTS)-X(NPTS+l))/6. 

DELTAX  -  X(NPTS+2) 
end  if 

FIRSTY  -  YtNPTS+l ) 

DELTAY  -  Y(NPTS*2) 

call  AXISU. 0,1.0, XTITLE, XLEN, 6. ,0. .FIRSTX .DELTAX) 
call  STAXISf .15, .22, .10, .080,2) 

call  AXISU.  ,1.  .YTITLE,  YLEN,*.  ,90.  .FIRSTY, DELTAY) 
cell  S YMBOL(PTX,PTY, CHARHT.PT I TLE, 0. , NCHAR) 
if  (PPLANE  .eq.  1)  then 

call  SYMBOL ( 3 . 0 , 5. 25, . 18, ’ ( ' ,0 . , 1) 
call  NUMBERt 999. ,5.25, . 18 .BEGTIM, 0 .,* ) 
call  SYMBOL(999. ,5.25, .18, '  -  ’,0.,3) 
call  NUMBER(999. ,5.25, .18, FINTIM, 0. ,*) 
call  SYMBOL(999. ,5.25, . 16, •  aeconda ) ' , 0 . , 9) 
end  if 

call  PLOT ( 1 . ,1. ,-13) 
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call  LINE(X  Y.NPTS  )  CO) 
call  PLOT ( 0  0.0  0  939! 


MODEL-99 

IOPORT-99 


RETURN 

END 


PLOTTING  SUBROUTINES 
(multi-  function  plot) 


Subroutine  MGRAPH :X . Y5 , Y6 . Y7 , Y6 , LINEO .DISOPT , KPWM , DBAND , 
XO.YO.WFACT) 

implicit  REAL-1  (A-Z) 

COMMON  BEGTIM . FINTIM. NPTS . IOPORT , MODEL , XLEN , YLEN , PLEN , PPLANE , 
XTITLE , YTITLE , PTITLE 

reel**  X(1010  )  .  Y5  ( 1010  ) .  Y6(  1010  )  ,  Y7  ( 1010 ) ,  Y8(  1010 )  .LINEO  ( 1010  ) 

integer-2  NPTS . IOPORT , MODEL , XLEN , YLEN, PPLANE 

charactar*l  DISOPT 

character-3  ANS 

charactar-20  XTITLE , YTITLE 

character-51  PTITLE 


WFACT- . 5 
.  . . Time  axle  . . . 

X(NPTS+1)-BEGTIM 
FIRSTX  -  BEGTIM 
X { NPTS+2 > -(BEGTIM-FINTIM ) / 10 . 
DELTAX  -  (FINTIM- BEGTIM)  / 10  . 

call  SCALEt Y5 , 1  ,NPTS,1) 
FIRSY5-Y5(NPTS+1) 

DELTY5“Y5( NPTS+2) 

LINEO (NFTS+1 )-Y5 ( NPTS+1 ) 

LINEO (NPTS+2 )-Y5<NPTS+2> 

Y6  (NPTS+1)— 1.0 
Y6(NPTS+2)-.2 
Y7  (NPTS+1  >—1.0 
Y7(NPTS+2)-.2 
Y8(  NPTS+1)— 12.0 
Y8(NPTS+2)-l . 

CALL  PLOTS (0, IOPORT, MODEL) 

CALL  FACTOR(WFACT) 
if  (DISOPT  .eq.  ’1’)  then 
cell  PLOT (2.5,1. ,-13) 
elseif  (DISOPT  eq  ’2')  then 

cell  PLOT(XO/WFACT,YO/WFACT,-13) 
Draw  a  border 

cell  PLOT (16.0,0.0,2) 
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call  PLOT <16  0.12  0.2) 
call  PLOT (0.0. 12  0.2) 
call  PLOTCO .0 ,0 .0 ,2) 
Radafina  origin  . 

call  PLOTU  3.11.0,-13) 
and  if 


CALL  STAXISC .20.  27, .16,  080.2) 

CALL  AXIS(0. 0,0.0, 'TIME  ( sac ) ' , -10 , 10 . , 270 , , FIRSTX , DELTAX ) 
CALL  STAXISC . 20 , . 27 . . 16 , . 080 . 1 ) 

CALL  AXISC0. .0. , 'ERROR  SIGNAL' ,12.*  ,0  , FIRSY5 . DELTY5 ) 

CALL  LINECY5. X.NPTS, 1,0,0) 

CALL  CURVE (LINE0 , X.NPTS. - . 1 ) 

CALL  AXIS(5. .0. . 'REFERENCE  SIGNAL' , 16 , 5 . , 0 . , 0 . , . 2 ) 

CALL  LINE(Y6, X.NPTS, 1,0,0) 

C 

CALL  AXIS!  S . ,-10. .'THRESHOLD  VOLTAGE' ,-17,5.  ,0. ,0. , .2) 
CALL  NEWPEN ( 2 ) 

CALL  LINECY7, X.NPTS, 1,0,0) 

CALL  NEWPEN  C 1 ) 

C 

CALL  STAXISC .20, .27, . 13, ,080,-1) 

CALL  AXISC 11 . .0. . 'DIRECTIONAL  LOGIC' ,17,2. ,0. ,-l. ,1. ) 

CALL  LINECY8, X.NPTS, 1,0,0) 

C 

PTITLE-'PWM  OPEN  LOOP  PERFORMANCE' 

call  SYMBOL (I*. 2, -1.3, . 35 , PTITLE , 270 . ,26) 

call  SYMBOL ( 13. 6, -1.0, .3, 'GAIN  -  ',270. .7) 

call  NUMBER! 13.6,999. , .3 , KFWM. 270 . , 2 ) 

call  SYMBOL ( 13 .6, -5.0, .3,’ DEAD  ZONE  -  ’,270. ,12) 

call  NUMBER! 13.6,999. , . 3 , DBAND , 270 . , 2 ) 

C 

CALL  PLOTCO. 0,0. 0,999) 

C 

MODF.L-99 

IOPORT-99 

C 

RETURN 

END 

c 

C  *****  Cutoff-Saturation  Limiting  Subrouting  ***** 
c  . . 

Subrouting  LIMIT (RSAT , RCTJT , INPUT , OUT) 
implicit  REAL**  CA-Z) 
if  (INPUT  lg.  RSAT)  thgn 
OUT-RSAT 

glagif  (INPUT  ,gg.  RCUT)  thgn 
OUT-RCUT 

glag 
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OUT- INPUT 


•nd  if 


riturn 

•nd 

C  *****  Function  Switch  Subroutine 


Subroutine  FCNSW(X1 ,X2 ,X3  , X* ,  OUT ) 
implicit  REAL**  (A"Z) 

If  (XI  It.  0.0)  then 
OUT-X2 

•Liaif  (XI  ,eq.  0.0)  th«n 
OUT-X3 

•  Is* 

OUT-X* 

•nd  i  f 

C 

return 

•nd 

C  *****  Step  function  Subroutine  ***** 

C 

Subroutine  STEPCTIME , TSTEP.OUT) 
implicit  REAL**  (A'Z) 
if  (TIME  ge.  TSTEP)  then 
OUT- 1.0 

•  lee 

OUT-O . 0 
•nd  if 

C 

return 

•nd 

C  *•••••*•*••••***•••••*•••••••*•• 

C  *••*«  Deedepece  Subroutine  ***** 

C  •••*•••••••••••••••••*»••••*•.*• 

Subroutine  DEADSP(P1 , P2 , VSGDEL , VSGERR) 
implicit  REAL**  (A-Z) 
if  (VSGDEL  .gt.  P2)  then 
VSGERR-VSGDEL - P2 
•leeif  (VSGDEL  It.  PI)  then 
VSGERR-VSGDEL -PI 

•  lee 

VSGERR-0 .0 
•nd  if 

C 

return 

•nd 

C  *****  Reap  Subroutine  ***** 

C  ........................... 


Subroutine  RAMP ( T IME . TRAMP . OUT ) 
implicit  REAL-4  (A-Z) 

If  (TIME  ge  TRAMP)  then 
OUT-TIME-TRAMP 

else 

OUT-O . 0 
end  if 

return 

end 


—  TIME  CONSTANT  — 


Subroutine  TCONST ( IC , X , TAU , NTIME , NTIM , DELTIM, Y ) 
implicit  reel**  (A-Z) 
integer-2  NTIME, NTIM 
if  (NTIME  .ne.  NTIM)  IC-Y 
DECAY-exp( -DELTIM/TAU) 

Y-X- (X-IC )*DECAY 
if  (NTIME  .eq.  1)  Y-IC 
NTIM- NTIME 

return 

end 


*****  Firet  Order  Derivetive  Subroutine 


Subroutine  DERIV(DELTIM, NTIME , NTIM1 , IC2 , XM1 . NOWVAL . XX , XDM1 , 
XD.XDDM1.XDD, SLOPE) 
implicit  REAL-4  (A-Z) 
integer-2  NTIME, NTIM1 

if  (NTIME  eq.  NTIM1 )  then 
XX-NCMVAL 
else 
XM1-XX 
XX— NOWVAL 
XDM1-XD 
XDDM1-XDD 
end  if 

XD-(XX-XMl) /DELTIM 
if  ( ebi (XD )  .It.  l.E-8)  XD-0  . 
if  (NTIME  .eq.  1)  XD-IC2 
XDD-(XD-XDM1 ) /DELTIM 
if  (ebi(XDD)  .It.  l.E-8)  XDD-0 . 0 

NTIM1-NTIME 

XPRED-XX+XD-DELTIM-XDD*  ( DELTIM— 2 )  /2 . 0 


if  ( aba (XFRED )  .It  l.E-8)  XPRED-0 . 0 
SLOPE" (XPRED-XM1 ) / (2 . 0*DELTIM) 
if  (abs(SLOPE)  .It.  l.E-8)  SLOPE-O.O 
C 

return 

end 

c 

C  *****  Trapezoidal  Integration  Subroutine  ***** 

C  .*....«***....*.**«**..****..***.***..*...***. 

Subroutine  INTGRL < NTIME . NTIM2 , DELTIM , IC3 , FREVAL , NOWVAL , 
+  CURVAL ,  OUTOLD ,  OUTKEW ) 

implicit  REAL*4  (A'Z) 
integer*2  NTIME, NTIM2 
C 

if  (NTIME  . eq .  NTIM2)  then 
CURVAL-NOWVAL 

elae 

PREVAL  *  CURVAL 
CURVAL  -  NOWVAL 
OUTOLD  -  OUTNEW 
end  if 

if  (NTIME  .eq.  1)  OUTOLD-IC3 
OUTNEW  -  OUTOLD+(CURVAL+PREVAL)*DELTIM/2. 
NTIM2-NTIME 
C 

return  ' 

end 

C  *.....***««****...****•*************.•*. 

c  ..*..  CLEAR  SCREEN  AND  HOME  CURSOR  ***** 

C  *****«••**.•*«***«*.***«**•*«******»«**• 

subroutine  CLRSCR 
character*l  C1.C2.C3.C* 
integer*2  IC(a) 

equivalence  (Cl , IC( 1 ) ) . (C2, IC(2) ) . (C3 , 10(3 ) ) , (C4 , IC( A ) > 
data  IC/16*1B,16#5B,16#32,16**A/ 

C 

C  ***  Writ*  Eacap*  Cod*  to  Display  *** 
write(*,l)  C1,C2,C3 ,CA 
1  format( IX, 1A1 ) 

C 

return 

end 

C 

C  «•*»«  Position  Cursor  by  Row, Column  ***** 

C  .*.*•.•.»**«*«•.«*«**.*»****.*•.*****..»« 

subroutine  GOTOXY ( ROW , COLUMN ) 
integer*2  IC( a ), ROW , COLUMN , L 
character*l  Cl ,C2 ,C5 ,C8 ,LC( 5) 
character*5  CBUFF 

equivalence  (Cl ,  IC(  1 ) ) .  (C2 .  IC(2) ) ,  (C5 ,  ICO ) ) ,  (C8.  IC( a ) ) . 
*  (CBUFF. LC(1)) 
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APPENDIX  C 


LUMPED  PARAMETER  MODEL  SIMULATION  PROGRAM 


SNOf loatcalls 

SNOdebug 

C 

c  _ 

C  I  I 

C  |  ROSSITTO,  VS  THESIS  PROF  GERBA  03/26/87  | 

C  | _ LINEARIZED_MODEL _ | 

C 

C  This  program  simulates  the  averaged  parameter  model  configured 

C  for  position  control.  Options  are  available  to  the  user  for 

C  Pulse  Width  Modulation,  Relay,  or  Saturating  Amplifier  control. 

C  Step,  Ramp,  &  Sinusoidal  Responses  are  available.  Both  second 

C  and  third  order  models  may  be  analyzed. 

IMPLICIT  REAL**  (A-Z) 

C0M10N  BEGTIM ,  FINTIM ,  NPTS  ,  IOPORT ,  MODEL ,  XLEN ,  YLEN ,  PLEN ,  PLEN1 , 

+  XTITLE , YTITLE, PTITLE, PTIT1 

REAL**  X< 1010), Ylt 1010 ). Y2( 1010), Y3( 1010 ),Y*(1010) 

INTEGER*2  NTERMS  ,  IOPORT ,  MODEL ,  XLEN ,  YLEN ,  NTIME ,  NUMIT ,  NTIM1 , 

+  NTIM2 , NTIM3 , NTIM* , DIR, PMODEL , NPTS , NCTR , PPLANE , 

+  SIM2PL , ECTR , EDCTR , NUMBER , ND1M , CTR , ELEMNT , SYSORD , TEMORD 

LOGICAL*2  WAITNG, TOGGLE 
CHARACTER* 1  DISOPT.PLOPT 

CHARACTER*6  ANSI , ANSI 1 ,ANS21 , ANS27 , PRTSEL , NONL IN 
CHARACTER* 15  TYPE, TYPE 1 
CHARACTER*25  XTITLE , YTITLE , NLCHAR 
CHARACTER* 51  FRTCHR , PTITLE , PTIT1 
C 

C  ...  Introductory  Page  <1  time  good  deal!) 
call  CLRSCR 
writet* , * ) 

PAUSE 

c  a*.*....*.************..*.*****..***.** 

C  ***  OPEN/READ/CLOSE  INPUT  DATA  FILE  *** 

C  a*...*.**......*.**.**.*.....*...*.*... 

C 

1 3  open ( 7 , FILE- ' LM . INP ' , STATUS- ' OLD ’ , ACCESS- -  SEQUENTIAL  * ) 

raad( 7 , 1000 )  PMODEL . PRTCHR 
read! 7 , 1020 )  BEGTIM , FINTIM , MAXITS , SIM2PL 
read ( 7 , 1022 )  KPWM, KV , E0 , EDOTO 
readt  7 , 1024 )  R , L , J , F , KT , KB , KP 
read (7, 1026)  PERIOD . DBAND , XORG , YORG 
read (7, 1028)  KA, SYSORD 
readt 7, 1030)  TYPE , STPMAG , RSLOPE , SINAMP 
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read (7, 1032)  SINFRQ , SINPHA 
close  C  7 , STATUS" 'KEEP' ) 


C  ***  DISPLAY  MAIN  MENU  SELECTIONS  *** 

C 

C 

1  call  CLRSCR 

call  GOTOXY (8,1) 
write!* , 5) 
read ( * , 1 (A)' )  ANSI 
C  ...  Hardware  Options  . . , 

if  ((ANSI  .eq.  'h')  .or.  (ANSI  .eq.  ’H’))  then 
C 

101  call  CLRSCR 

call  GOTOXY (17, 24) 

write(*, *)'***  CURRENT  PRINTER  SELECTION  »**■ 
call  GOTOXY (20,20) 
write (* , * )  PRTCHR 
call  GOTOXY (10,1) 
write(* , 105) 
read( * , ' (A)' )  ANS11 
C 

C  ...  Printer  Options  , . . 

if  ( (ANS11  .eq.  ’p’ )  .or.  (ANS11  .eq.  ’P’))  then 
131  cell  CLRSCR 

write!* , 130 ) 

read( * , '(A)')  PRTSEL 
C 

i f  ( FRTSEL  . eq .  ’O’)  then 

PRTCHR-’Epson  FX-80  Printer,  single  density’ 
PMODEL-O 

elself  (FRTSEL  eq.  ’1’)  then 

PRTCHR” 1  Epson  FX-80  Printer,  double  density’ 
PMODEL-1 

elself  (FRTSEL  .eq.  ’2’)  then 

PRTCHR” 1  Epson  FX-80  Printer,  dble  spd.dual  density’ 
PMODEL-2 

elseif  (PRTSEL  .eq.  ’3')  then 

PRTCHR”’Epson  FX"80  Printer,  quad  density’ 

PMODEL-3 

elseif  (PRTSEL  .eq.  ’4’)  then 

PRTCHR“'Epson  FX-80  Printer,  CRT  Grephics  I’ 
FMDDEL-4 

elseif  (PRTSEL  .eq.  ’5’)  then 

PRTCHR” ’ Epson  FX-80  Printer,  plotter  graphics' 


FMODEL-5 

elseif  (PRTSEL  .eq.  '&')  then 

PRTCHR” 1  Epson  FX-80  Printer,  CRT  Graphics  II' 
PMODEL-6 

elseif  (PRTSEL  .eq.  ’10’)  then 


PRTCHR- ’ Epson  FX-100  Printer,  single  density’ 
FMODEL-7 

elseif  (PRTSEL  . eq.  ’ll')  then 

PRTCHR- 'Epson  FX-100  Printer,  double  density' 
PMODEL-11 

elseif  (PRTSEL  .eq,  '12')  then 

PRTCHR-' Epson  FX-100  Printer,  dble  spd.dual  density’ 
FMODEL-12 

elseif  (PRTSEL  eq.  ’13’)  then 

PRTCHR-’ Epson  FX-100  Printer,  quad  density’ 

FWODEL-13 

elseif  (PRTSEL  .eq.  '14')  then 

PRTCHR- 'Epson  FX-100  Printer,  CRT  Graphics  I' 
PMODEL-14 

elseif  (PRTSEL  eq .  ’15’)  then 

PRTCHR- ' Epson  FX-100  Printer,  plotter  graphics’ 
FMODEL-15 

elseif  (PRTSEL  .eq.  '16')  then 

PRTCHR- ’ Epson  FX-100  Printer,  CRT  Graphics  II' 
PMODEL-16 

elseif  (PRTSEL  .eq.  ’20')  then 

PRTCHR-’ HP  7470A  Graphics  Plotter' 

PMODEL-20 

elseif  (PRTSEL  .eq.  '30’)  then 

PRTCHR- ' HP  7475A  Graphics  Plotter’ 

PMODEL-30 

elseif  (PRTSEL  eq.  '60')  then 

PRTCHR- 'HP  2686A  Laser  Jet  Printer' 

PM0DEL-60 

C 

C  ...  Quit  the  Printer  Menu  . .  . 

elseif  ((PRTSEL  eq.  ’ Q ' )  .or.  (PRTSEL  .eq.  'q'))  then 
go  to  101 

else 

go  to  131 
end  if 
go  to  101 
C 

C  ...  Quit  the  Hardware  Menu  . . . 

elseif ( (ANS11  .eq.  'q’ )  .or.  (ANS11  .eq.  ' Q ’ ) )  then 
go  to  1 

else 

go  to  101 
endif 
C 

C  ...  Motor  Parameters  . . . 

elseif  ((ANSI  eq.  ’m’)  or.  (ANSI  eq.  ’ M ’ ) )  then 
C 

201  call  CLR5CR 

writet  * , 230 )  KT . KB ,R , L . J ,F , KP ,KV , SYSORD 
rendt*. ' (A) ’ )  ANS21 
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c 


if  (ANS21  .aq.  'KT')  than 
call  GOTOXY (24,1) 

writa(* , ‘ (A\ ) ' ) ’Entar  a  REAL  valua  for  KT-->  ' 
raad(* , * )  KT 
go  to  201 

alsaif  (ANS21  .aq.  ’KB’)  than 
call  GOTOXY (24,1) 

writa(* , ' (A\ )’) 'Entar  a  REAL  valua  for  KB--»  ’ 
raad(*,»)  KB 
go  to  201 

alsaif  (AKS21  .aq.  'R')  than 
call  GOTOXY (24,1) 

writa(*. ' (A\ )') ’Entar  a  REAL  valua  for  R-->  ’ 
raad( * , * )  R 
go  to  201 

alsaif  (ANS21  aq.  ’L’)  than 
call  GOTOXY ( 2S , 1 ) 

writa<*, ‘ (A\ ) ' ) 'Entar  a  REAL  valua  for  L-->  1 
raad ( * , *  )  L 
go  to  201 

alsaif  (ANS21  .aq.  'J')  than 
call  GOTOXY ( 2* , 1) 

writa(* ,’ (A\ )')' Entar  a  REAL  valua  for  J--»  • 
raad ( * , * )  J 
go  to  201 

alsaif  (AHS21  aq.  'F’)  than 
call  GOTOXY <21. 1) 

writa(*. ' (A\ ) ’ ) 'Entar  a  REAL  valua  for  F--»  ' 
raad ( * , * )  F 
go  to  201 

alsaif  (ANSZ1  .aq.  ’KP’ )  than 
call  GOTOXY (24,1) 

writa(* ,’ (A\ )’) ’Entar  a  REAL  valua  for  KP--»  ' 
raad(*,*>  KF 
go  to  201 

alsaif  (ANS21  aq.  ’KV’)  than 
call  GOTOXY ( 2* , 1 ) 

writa(* ,’ (A\ )’)’ Entar  a  REAL  valua  for  KV-->  ’ 
raad(* , • )  KV 
go  to  201 

alsaif  (ANS21  aq.  ’SYSORD’)  than 
call  GOTOXY ( 2*, 1) 

writat  * , ’(A\)’ )' Entar  an  INTEGER  valua  (2  or  3)  for  SYSORD--> 
raad(*. •)  TENORD 

if  UTEMORD  .na.  2)  and.  (TIMORD  na  3))  than 
call  CLRSCR 
call  GOTOXY ( 10 . 10) 

**rlta(*,*>  "Tha  Systam  Ordar  may  ba  2  or  3  only!!’ 
call  GOTOXY (22,1) 


•  Ill 


SYSORD-TEMORD 
•ndlf 
go  to  201 

Quit  Motor  Parameters  Menu  .  .  . 
elseif  (ANS21  .  eq.  'Q' )  then 
go  to  1 

else 

go  to  201 


NON-LINEAR  ELEMENT  SELECTION  MENU  . . . 


elseif  ((ANSI  eq .  'n‘)  or  (ANSI  eq.  ’N')>  then 
cell  CLRSCR 
cell  GOTOXY (21 , 1 ) 
write(*,272)  NLCHAR 
cell  GOTOXY (1,1) 
write(* , 270 ) 
readt*, ' (A)1 )  ANS27 
.  RELAY  AS  NON-LINEAR  ELEMENT  .  .  . 

if  ( ( ANS27  eq.  'r')  .or.  (ANS27  eq.  'R'))  then 
ELEMKT-1 
NLCHAR- 'RELAY' 
call  CLRSCR 
NONLIN-'R’ 
write(* , 290 )  DBAND 
reed(*, • (A) * )  ANS21 


i£  (ANS21  .eq.  'DBAND')  then 
cell  GOTOXY (24,1) 

write(*. ' (A\ )')’ Enter  a  REAL  value  for  DBAND-->  * 
read ( * , * )  DBAND 
go  to  291 

elseif  ((ANS21  eq.  ’q’)  or,  (ANS21  eq.  ’Q’))  then 
go  to  14 


go  to  291 
endif 

PULSE  WIDTH  MODULATOR  AS  NON-LINEAR  ELEMENT  . . . 

elseif  ((ANS27  eq.  'p' )  or.  (ANS27  eq.  ’P’))  then 
ELEMNT-3 

NLCHAR- ' PULSE  WIDTH  MODULATOR’ 
cell  CLRSCR 
NONLIN- ’ P ’ 

writet * , 300  )  DBAND , PERIOD , KFWM 
reedt*, ' (A) ' )  ANS21 


if  ( ANS21  eq  'DBAND')  then 
call  GOTOXY (24 . 1) 

writet *,’ (A\ )')' Enter  a  REAL  value  for  DBAND--* 
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raad(*,*)  DBAND 
go  to  301 

alaaif  ( ANS21  . aq.  'PERIOD’)  then 
call  GOTOXY (24, 1 ) 

writa(*, ' (A\ )') 'Enter  a  REAL  valua  for  PERIOD" »  ' 

raad ( * , * )  PERIOD 
go  to  301 

alsaif  (ANS21  eq  'KPWM')  than 
call  GOTOXY (24, 1) 

wnte<*.  ■  (A\ )')  'Entar  a  REAL  valua  for  KPWM-->  • 
raad( * , * )  KPWM 
go  to  301 

elsaif  ( ( ANS21  aq.  'q')  .or.  (ANS21  aq.  ' Q • ) )  then 
go  to  14 

alsa 

go  to  301 
and  if 

C 

C  SATURATING  AMPLIFIER  AS  NON-LINEAR  ELEMENT  .  .  . 

alaaif  ( ( ANS27  .aq.  ’a’)  .or.  (ANS27  aq.  'A'))  than 
ELEMNT-2 

NLCHAR- ■ SATURATING  AMPLIFIER' 

281  call  CLRSCR 

NONLIN-'A' 

writa(*,280)  DBAND, KA 
raad(*. ' (A)' )  ANS21 
C 

If  ( ANS21  aq.  'DBAND')  than 
call  GOTOXY(24,l) 

wrlte(*. ‘ (A\ )') 'Enter  a  REAL  valua  for  DBAND--*  ' 
read ( * , • )  DBAND 
go  to  2B1 

alaaif  (ANS21  aq.  'KA' )  than 
call  GOTOXY (24,1) 

write(«, ' (A\ )’) 'Enter  a  REAL  valua  for  KA--»  ’ 
raad ( * , • )  KA 
go  to  2S1 

alaaif  ( ( ANS21  .aq.  'q')  or.  CANS21  aq.  ' Q ' ) )  than 
go  to  14 

alaa 

go  to  281 
and  If 

C 

alaaif  ( (AHS27  aq  'q')  or.  (ANS27  aq  ' Q ' ) )  than 
go  to  1 

alaa 

go  to  14 
andi  f 


Simulation  Optlona 

alaaif  ((ANSI  aq  o')  or  (ANSI  aq  '0'))  than 
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A 


LU6 


vvv.y -'.i*: 


aCarfbuCa 


,  a  •”»  -*\m~  ■*JCtLK  V' 


d* 


call  CLRSCR 


I 

DELTIM-(FINTIM-BEGTIM)/(1000 ,»SIM2PL> 
if  (FINTIM/DELTIM  .  gt.  MAXITS)  DELTIM  -FINTIM/MAXITS 
NTERMS-IFIX!FINTIM/DELTIM>+1 

write!* , 2*0 )  BEGTIM , FINTIM , MAXITS , SIM2PL , EO , EDOTO . XORG . YORG . 

DELTIM  .NTERMS 
read!*, ‘ (A)1 )  ANS21 

if  (ANS21  eq.  'BEGTIM')  then 
call  GOTOXY (24,1) 

write!*. ' (A\)’ )' Enter  a  REAL  value  for  BEGTIM-->  ’ 
read( * , * )  BEGTIM 
go  to  202 

elaeif  (ANS21  .aq,  'FINTIM')  then 
call  GOTOXY (24,1) 

write!* , ' (A\ )  ‘ ) 'Enter  a  REAL  value  for  FINTIM-->  ' 
raad( * , * )  FINTIM 
go  to  202 

elaeif  (ANS21  eq  'MAXITS')  then 
call  GOTOXY (24,1) 

write!*. ' <A\ )') 'Enter  a  REAL  value  for  MAXITS--*  ’ 
read ( * , * )  MAXITS 
go  to  202 

elaeif  (ANS21  eq  'SIM2PL' )  then 
call  GOTOXY ( 2* , 1 ) 

write!*, ■ (A\ )’ )' Enter  a  INTEGER  value  for  SIM2PL--*  ’ 
read(* , * )  SIM2PL 
go  to  202 

elaeif  (ANS21  eq.  'E0’>  then 
call  GOTOXY ( 2* , 1 > 

write!* . ’ (A\ )') 'Enter  a  REAL  value  for  E0  (degree*)--*  ' 
read!*.*)  E0 
go  to  202 

elaeif  (ANS21  eq.  'EDOTO')  then 
call  GOTOXY ( 2* , 1 ) 

write!* .' (A\ )’)’ Enter  a  REAL  value  for  EDOTO  (d*g/sec)--» 
read!*,*)  EDOTO 
go  to  202 

elaeif  (ANS21  eq  'XORG')  then 
call  GOTOXY ( 2* , 1) 

write!* ,' iA\ )’)' Enter  a  REAL  value  for  XORG--*  ' 
read!*.*)  XORG 
go  to  202 

elaeif  (ANS21  eq  'YORG')  then 
call  GOTOXY (2*. 1) 

write! *.' (A\ )')' Enter  a  REAL  value  for  YORG--*  ' 
read!*  •)  YORG 
go  to  202 
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C  ...  Quit  Simulation  Options  Manu  . . . 

alsaif  (ANS21  ,«q.  'Q' )  than 
S°  to  1 

alsa 

go  to  202 
and  if 
C 

C  ...  Command  Input  Salactior.  .  . 

elseif  ((ANSI  .aq.  'c')  or.  (ANSI  .aq.  ’ C ' ) )  than 

203  call  CLRSCR 

wri ta ( * . 2A5 )  TYPE , STFMAG , RSLOPE , SINAMP , SINPRQ . SINPHA 
raad(», 1 (A)' )  ANS21 

if  CANS21  .aq.  'TYPE')  than 
call  GOTOXY(21.1) 

*»rlta(* ,  '  (A\ )  ’ )  ■  Entar  a  STEP,  RAMP,  or  SINE-->  • 
raad ( * , ' (A)' )  TYPE1 

if  ( (TYPE1  na.  'STEP')  .and.  ( TYPE 1  .na.  'RAMP')  .and 
♦  (TYPE1  .na.  ’SINE’))  than 

call  CLRSCR 
call  GOTOXY (10,10) 
writa(*,*>  ■  Invalid  Salaction 
call  GOTOXY (20 , 1 ) 

PAUSE 
go  to  203 
alsa 

TYPE-TYPE 1 
and  if 

C 

go  to  203 

alsaif  ( ANS21  aq.  'STFMAG')  than 
call  GOTOXY ( 2* , 1 ) 

«*r  ita  ( * , 1  ( A\  ) '  )  ‘ Entar  a  REAL  valua  for  STFMAG--*  ' 
raad( * , * )  STPMAG 
go  to  203 

alsaif  (ANS21  aq.  ’RSLOPE')  than 
call  GOTOXY (2* , 1 ) 

«*nta(».  '  (A\ )')  'Entar  a  REAL  valua  for  RSLOPE--*  ' 
raad(* , * )  RSLOPE 
go  to  203 

a  alsaif  (ANS21  aq.  'SINAMP')  than 

call  GOTOXY (2*. 1) 

writat*. ' (A\ )•) 'Entar  a  REAL  valua  for  SINAMP--*  ' 
raad( * . * )  SINAMP 
go  to  203 

alsaif  ( ANS21  aq  'SINPRQ')  than 
call  GOTOXY ( 2 i . 1) 

writa(*.'(A\)’)'Entar  a  REAL  valua  for  SINPRQ--*  • 
raad ( * . * )  SINFRQ 


go  to  203 

elseif  ( ANS21  .eq.  ' SINPHA ' )  then 
call  GOTOXY (24,1) 

write (* , ' (A\ ) 1 ) ' Enter  a  REAL  value  for  SINPHA 
read ( * , * )  SINPHA 
go  to  203 

Quit  Simulation  Options  Menu  . 
elseif  ( ANS21  eq.  ’O')  then 
go  to  1 

else 

go  to  203 
end  If 

Save  Options  to  File  .  .  - 

elseif  ((ANSI  . eq .  ’s')  or.  (ANSI  .eq.  ’S’))  then 


***  OPEN /WRITE /CLOSE  INPUT  DATA  FILE  **» 


open ( 7 . FIL£”'LM . INP ' , STATUS- ’ NEW > ) 
wnte(  7  , 1000  )  PM0DEL ,  PRTCHR 
write(7. 1020)  BEGTIM, FINTIM.MAXITS , SIM2PL 
write(7, 1022)  KI*H,KV,  E0 .  EDOTO 
write( 7 , 1024 )  R. L , J , F , KT , KB , KF 
write(7 . 1026)  PERIOD , DB AND , XORG. YORG 
write(7 , 1028)  KA , SYSORD 
wrlte<7, 1030)  TYPE , STFMAG, RSLOPE . SINAMP 
writet  7 , 1032 )  SINFRQ, SINPHA 
wrlte(7 . 2000 ) 
closet  7 , STATUS- ' KEEP’ ) 

go  to  1 

Run  the  Program 

elseif  ((ANSI  .eq.  ’r')  or  (ANSI  eq.  'R'))  then 

go  to  2 

Quit  the  Program  . 

elseif  ((ANSI  eq  ’q')  or.  (ANSI  eq.  ’0'))  then 

stop 

else 

go  to  1 
endi  f 

Open  an  Output  Data  File 
open <*, FILE- ’ LM  OUT' . ST ATUS- ' NEW • ) 

PI-3  1*159 
N-  1 


nitializations 


NCTR-0 
NPTS-0 
NTIM2-1 
NTIM3-0 
NTIMA-0 
PARS  1-0  0 
PARG2-0  0 
PVALA-0 . 
CARG1-0  0 
CARG2-0  0 
CVAL1-0 . 

TOT  1-0 .0 
TCT2-0  0 
TVAL1-0 . 0 
TVAL2-0  0 
TVAL*-0 
XM1-0  0 
XX-0 . 0 
XDM1-0 . 0 
XD-0  0 
XDDM1-0 . 0 
XDD-0  0 
Xl-0  0 
Fl-0  0 
F2-0.0 
X3-0.0 
WM1-0.0 
WM-0 . 0 
IM-0 
IMO-O 

TSTART-0  0 
THEDEG-0  0 
TOGGLE- . trua 

pplahe-o 

HUMBER-0 

HDIM-20 

VIH-0 


Preliminary  Relationahipa 

Initial  condition*  Tor  THETA( Tin . degraea  and  Omega [ Tin . degrees 
EORAD-10.»EO*PI/1BO 
EDOT OR- 1 0  »EDOT0»PI/180 
iT  CKP  ne  0  )  than 
WMO— EDOTOR/KP 
THETAO— EORAD/KP 
alaaif  (KP  aq  0  )  than 
WMO— EDOTOR 
THETAO  — EORAD 
and  IT 

IM0-tVIN-WM0*KB)/R 

X2*AHM0 


PTHETA-THETAO 

TAU1-L/R 

TAU2-J/F 

c  ft  1.1  CLRSCR 

Output  Simulation  Option*  to  Output  Dftt*  Filft 
wnte(*.  1200)  SYSORD  ,  BEGTIM .  FI  HUM,  MAX  ITS  , SIM2PL , KT , <B . R  L.J.F  KP. 

KV.KA. PERIOD. DBAND.EO.EDOTO 
»r 1 t« ( i . 120 1)  TYPE , STPMAG. RSLOPE , SINAMP , SINFRO . SINPHA 


Display  thft  *imul«tion  h«»d»r  . . . 

call  CLRSCR 

call  GOTOXY (10.27) 

write(*.‘)  'Simulation  in  Progress' 

DELTIM-(FINTIM-BEGTIM) / ( 1000 . *SIM2PL) 

if  (FINTIM/DELTIM  gt  MAXITS)  DELTIM  -FINTIM/MAXITS 

NTERMS-IFIX(FINTIM/DELTIM)+1 

call  GOTOXY ( 1* . 1) 

wnta(*  ,  15)  DELTIM, NTERMS 

15  formate 16X ,  1  Simulation  Stap  Sira  --»  '.F9  8,’  aaconda',/, 
♦  17X, ’Total  Number  of  Stapa-->  ’,15) 

call  GOTOXY <21,1) 


If  ((NONLIN  . aq  ’r’ 
write!* . * )  • 
alaaif  ((NONLIN  aq 
write (* .  *)  ’ 


or  (NONLIN  aq  ’P. '))  than 

***  NON-LINEAR  ELEMENT  IS  RELAY  ***' 
a')  or.  (NONLIN  aq.  ’A'))  than 

»**  NON-LINEAR  ELEMENT  IS  SATURATING  AMPLI 


♦  FIER  ***' 

alaaif  ((NONLIN  .aq.  'p' )  .or.  (NONLIN  aq.  ■?'))  than 
write(* , * )  '  ***  NON-LINEAR  ELEMENT  IS  PWM  *** 


alia 


wrlte(*.‘)  1 


***  NON-LINEAR  ELEMENT  NOT  SELECTED  *** 


wnte(*,*)  ’  ...  Return  to  Main  Menu 

PAUSE 


go  to  1 
and  if 


SPACE-DELTIM/2.0 


***  START  MAIN  SIMULATION  LOOP  *** 


DO  100  NT IME*1  NTERMS 
TIME-(NTIME-l) ‘DELTIM 
NUMIT-0 
THETA-PTHETA 


“*  START  INNER  SIMULATION  LOOP  *“ 
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200 


NUMIT-NUMIT+1 

WM-X2 


C  .  Command  Input  Signal  Generator  . . . 
if  (TYPE  eq.  'STEP')  then 
ORDER*STPMAG 

elseif  (TYPE  eq.  ’RAMP’)  then 
ORDER *RSLOPE*TIM£ 
elseif  (TYPE  eq.  ’SINE')  then 

ORDER*SINAMP*sin(SINFRQ*TIME*SINPHA) 
end  if 


THETAP- . 1*THETA*180 . /PI 
0MEGAF-.1*WM*180./PI 
POSERR-ORDER-KP*THETAF-KV*OMEGAF 
c 

C  . .  Utilization  of  Non-Linear  Element  . . . 

C  PULSE  WIDTH  MODULATOR  . . . 

if  ((NONLIN  .eq.  'p')  .or.  (NONLIN  .eq.  ’P')>  then 
call  PWMOD (TIME .NUMIT .TSTART .PERIOD .TOGGLE , POSERS , 

+  DBAND  ,  VIN .  VREF  ,  THRESH, KFWM) 

C  IDEAL  RELAY  .  . 

elseif  ((NONLIN  eq.  'r'>  or.  (NONLIN  .eq.  'R'))  then 
call  RELAY (POSERR, DBAND. VIN) 

C  .  SATURATING  AMPLIFIER  .  .  . 

elseif  ((NONLIN  eq.  'a')  or.  (NONLIN  eq.  ’A’))  then 
call  AMPLIFt POSERR. DBAND. KA, VIN) 
else 

call  GOTOXY (21,1) 

write!*,*)  '  ***  NON-LINEAR  ELEMENT  NOT  SELECTED  *** 

write(*.*)  ’  ,  Return  to  Main  Menu 

PAUSE 
go  to  1 
end  if 


EN-VIN-WM*KB 
if  (SYSORD  eq  3)  then 

call  TCONST ( IMO . EN/R , TAU1 , NTIME , NTIM1 , DELTIM . IM ) 
elseif  (SYSORD  eq  2)  then 
INHEN/R 

else 

cell  CLRSCR 
call  GOTOXY (1C .10) 

wri te( *  *)  'SYSTEM  ORDER  IS  NOT  2  OR  3'1' 

PAUSE 
go  to  1 
end  :  f 


TT^IM*KT 


call  TCONST (WMO . TM/F . TAU2 .NTIME , NTIM2 , DELTIM, WM1 > 
call  INTGRL  (NTIME  ,  NTIM<< , DELTIM . THETAO  ,  PVAL-. .  WM1 , CVAL1 , TVAL4  ,  THET 1 ) 
THETA-THET1 


***  CONVERGENCE  CRITERIA  (Newton's  Method)  *** 


if  (NTIME  eq  1)  then 


go  to  150 


if  (NUMIT  .aq,  1)  then 
F2-(WM1-WM)*1.2 
X3-1.001*WM1+1.0E-* 
RELERR-abs(F2/X3) 
go  to  310 


F2-WM1-WM 

if  (FI  eq  F2)  F2- . 999*F2- 1 . E-8 
if  (X2  .ne.  0.)  RELERR-abs (F2/X2 ) 
if  (X2  eq.  0. )  RELERR-1. 
if  (RELERR  .gt.  l.E-8)  then 
X3“X2-F2* (X1-X2 ) / (F1-F2 ) 


310  X1-X2 


if  (NUMIT  ge  10)  go  to  150 
if  (RELERR  gt.  l.E-8)  go  to  200 


***  END  INNER  SIMULATION  LOOP  *** 


150  call  DERIV( DELTIM , NTIME  , NTIM3 . 0 .  . XM1 . WM1 , XX , XDM1 , XD , XDDM1 . XDD , 


X2-WM1+ALPHA*DELTIM 


PTHETA-THETA+W11»DELTIM 
THETAF-  1*THETA*180  /PI 
OMEGAF-  1*V*U*180  /PI 


Generate  Plotting  Arrays 
if  (TIME  ge  BEGTIM)  then 


V-  ,/V -V  -  - 

V  .  r  .  >  ,  •  .  hj,  -  «  '  .  " 


SKI 
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^  / 


NCTR-NCTR+1 

if  C (mod(NCTR,SIM2PL>  .eq.  0)  or.  ( NCTR  .eq.  1))  then 
NPTS-NPTS+1 
X(NPTS)-TIME 
Y 1 ( NPTS ) “THETAF 
Y2(NPTS)-CMEGAF 
Y3< NPTS (-ORDER 
Y4(NPTS)-IM 
end  if 
endif 
C 

100  CONTINUE 

C 

C  *«*  END  MAIN  SIMULATION  LOOP  *** 

C 

c 

close ( A , STATUS* ' KEEP' ) 

C 

C  .............................. 

C  .....  plotting  selection  ***** 

C  * . . 

c 

C  ***  Clear  Screen  &  Home  Cursor  *** 

400  cell  CLRSCR 
C 

write(*, 1305) 
read!*  ,  •  (AV  >  D1SOPT 
C 

if  tfDISOPT  .eq,  'm' )  .or.  CDISOPT  .eq.  ’M’)>  then 
MODEL-99 
IOPORT-99 

elseif  ((DISOPT  .eq.  ’p')  .or.  (DISOPT  .eq.  ’P'))  then 
MODEL-PMODEL 
IOPORT-1 

C  ...  Ioport-9600  ie  COM1  . .  . 

C  Ioport-9650  ie  COM2  . . 

if  ((MODEL  eq.  20)  or.  (MODEL  .eq.  30))  IOPORT-9600 


elseif  ((DISOPT 

.  eq. 

•r')  .or.  (DISOPT 

.  eq. 

’R’  )) 

then 

GO  TO  13 

elseif  ((DISOPT 

•q 

's')  .or.  (DISOPT 

.  eq. 

•S’  )) 

then 

C  ........................................ 

C  *♦*  OPEN /WRITE /CLOSE  INPUT  DATA  FILE  *** 


open (7. FILE- ' LM  INF' , STATUS-'NEW' ) 
write(7. 1000)  PMODEL . PRTCHR 
write(7.  1020)  BEGTIM .  FINTIM,  MAXITS  ,  SIM2PL 
write().1022)  KPWM, KV , E0 , EDOTO 
«nte(  7  .  1024  )  R.L.-J.F.KT.KB.KP 
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write (7, 1026)  PERIOD , DBAND , XORG , YORG 
wnte(7,  1026)  KA.SYSORD 
write (7, 1030)  TYPE , STPMAG.RSLOPE , SINAMP 
wnte(7, 1032)  SINFRQ.SINPBA 

write( 7 , 2000 ) 
c lose ( 7 , STATUS- ’ KEEP ' ) 

C 

go  to  400 
C 

elseif  ((DISOPT  .eq.  ’Q’ )  .or.  (DISOPT  .eq.  'q'))  then 
GO  TO  460 

else 

go  to  400 
end  if 
C 

410  call  CLRSCR 

if  ((DISOPT  .eq.  ’p1)  .or.  (DISOPT  .eq.  ’P1))  then 
call  GOTOXY(20 , 20 ) 
writef*,*)  PRTCHR 
call  GOTOXY (1,1) 
endif 

write(* , 1300 ) 
read(», 1 (A)1 )  PLOPT 
C 

if  ((PLOPT  .eq.  'Q' >  .or.  (PLOPT  .eq.  'q'))  then 
go  to  400 

elaeif  (PLOPT  .eq.  ’ 1’)  then 
XTITLE-’TIME  (seconds)1 
XLEN— 15 

YTITLE-'FIN  POSITION  (deg)1 
YLEN-19 

if  (ELEMNT  .eq.  1)  then 

PTITLE- 1  FIN  POSITION  RESPONSE  WITH  RELAY  CONTROLLER1 
PLEN-44. 

elaeif  (ELEMNT  .eq.  2)  then 

PTITLE- ’FIN  POSITION  RESPONSE  WITH  SAT  AMP  CONTROLLER1 
PLEN-46 . 

elseif  (ELEMNT  .eq.  3)  then 

PTITLE- 'FIN  POSITION  RESPONSE  WITH  FVM  CONTROLLER1 
PLEN-42. 
endif 

C 

if  (SYSORD  eq.  2)  ther 

PTIT1- 1 REL’.  CED  ORDER  MODEL1 
PLEN1-20 . 

else 

PTIT1-1 THIRD  ORDER  MODEL1 
PLEN1-18 
endif 

C 

call  MGRAPH(X, Y1.Y3 , XORG, YORG, DISOPT) 
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.•>  A,'  A 


c 

elseif  (PLOPT  .aq.  '2')  than 
XTITLE-’TIME  (seconds)’ 

XLEN--15 

YTITLE-'FIN  VELOCITY  (deg/sec)' 

YLEN-23 

if  (ELEMNT  .aq.  1)  than 

PTITLE-’FIN  VELOCITY  RESPONSE  WITH  RELAY  CONTROLLER’ 
PLEN-44 . 

elseif  (ELEMNT  .aq.  2)  than 

PTITLE-’FIN  VELOCITY  RESPONSE  WITH  SAT  AMP  CONTROLLER' 
PLEN-46 . 

elseif  (ELQ1NT  .aq.  3)  then 

PTITLE-'FIN  VELOCITY  RESPONSE  WITH  PWM  CONTROLLER’ 
PLEN-42. 
end  if 
C 

if  (SYSORD  .aq.  2)  then 

PTIT1-’ REDUCED  ORDER  MODEL’ 

PLEN1-20 . 

else 

PTIT1-’ THIRD  ORDER  MODEL’ 

PLEN1-1B. 
end  if 
C 

call  GRAPH(X,Y2,XORG,YORG,DISOPT) 

c 

elseif  (FLOPT  .aq.  ’3’)  than 
XTITLE-’TIKE  (seconds)’ 

XLEN--15 

YTITLE-’ MOTOR  CURRENT  (amps)’ 

YLEN-20 

if  (ELEMNT  .aq.  1)  than 

PTITLE-' MOTOR  CURRENT  RESPONSE  WITH  RELAY  CONTROLLER’ 
FLEN-45 . 

elseif  (ELEMNT  .aq.  2)  than 

PTITLE-' MOTOR  CURRENT  RESPONSE  WITH  SAT  AMP  CONTROLLER' 
FLEN-47. 

alsaif  (ELEMNT  .eq.  3)  than 

PTITLE-’ MOTOR  CURRENT  RESPONSE  WITH  PWM  CONTROLLER’ 
PLEN-43. 
end  if 
C 

if  (SYSORD  .aq.  2)  than 

PTIT1-’ REDUCED  ORDER  MODEL’ 

PLEN1-20. 

else 

PTIT1-’ THIRD  ORDER  MODEL’ 

PLEN1-18. 
and  if 
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call  GRAPH (X ,  Y4  , XORG , YORG , DISOPT) 


go  to  410 


go  to  400 
460  continue 


***  I/O  FORMAT  STATEMENTS  **» 

***************************** 


4  format (////, 25X , ’ LUMPED  PARAMETER  DC  MOTOR  SIMULATION',//, 
+  25X,’  LT  Vincent  S.  Rossitto , USN' , / , 

+  25X,’  Naval  Postgraduate  School’,/, 

+  25X, '  March  1987 ',////// ) 

5  format(32X, '***  MAIN  MENU  ***’,//. 

+  20X,'[H1 - >  HARDWARE  Configuration  Menu’,/, 

+  20X , ’ [M] - >  MOTOR  Parameter  Menu ',/ , 

+  20X,‘[N] - >  NON-LINEAR  Element  Selection  Menu’,/, 

+  20X, ' [0] - >  OPTIONS  for  Simulation',/, 

+  20X,'[C) - >  COMMAND  Input  Selection  Menu’,/, 

+  20X, ’ [S] - >  SAVE  All  Changes’ , / , 

+  20X,'[R] - >  RUN  Simulation  Program',/, 

+  20X,’[Q1 - >  QUIT  the  Program’,//, 

+  8X , ’ ENTER  SELECTION - > •  ,\) 


105  format (30X, '***  HARDWARE  MENU  ***’,//, 

+  20X, ' [P] - >  PRINTER/ PLOTTER  configuration  change’,/, 

+  20X,’[Q] - >  QUIT  THIS  MENU’ ,//, 

+  8X , ' ENTER  SELECTION - > ’ , \ ) 

1000  format ( IX , 13 , 2X, A50 ) 

1020  formate  lx, 3F15. 7, IX, 13) 

1022  formate  IX , 4F15 . 7 ) 

1024  formate IX, 7F8 , 4) 

1026  formate  IX, 4F8 . 4 ) 


1028  format  e  IX ,  F12 . 7  ,  IX ,  ID 
1030  formateiX , A15 , 3F15 . 7 ) 

1032  formateiX, 2F15. 7) 

2000  formateiX, ’END  OF  FILE') 

C 

130  FORMAT e 24X, '***  PRINTER  OPTIONS  MENU  *«*’,//, 

+  15X, ’ (0]  — >  Epson  FX-80  Printer,  single  density',/, 

+  15X,’[1]  — >  Epson  FX-80  Printer,  double  density',/, 

+  15X,’[2]  — >  Epson  FX-80  Printer,  dble  spd.dual  density’,/, 

+  15X,’[3)  -->  Epson  FX-80  Printer,  quad  density’,/, 

+  15X,’[4]  -->  Epson  FX-80  Printer,  CRT  Graphics  I’,/, 

+  1SX,’(S]  — >  Epson  FX-80  Printer,  plotter  graphics',/, 

+  15X,’[6)  -->  Epson  FX-80  Printer,  CRT  Graphics  II’,/, 


+  15X , ' ( 10 ]  ->  Epson  FX-100  Printer,  single  dsnalty’,/, 

+  1 5X , ’ Ill]  ->  Epson  FX-100  Printer,  doubls  density',/, 

+  1 5X , ‘ C 12 ]  ->  Epson  FX-100  Printer,  dble  spd.dual  density'./, 

+  15X,'[131  -■»  Epson  FX-100  Printer,  quad  density’,/, 

♦  1 5X , ' [ 1 A ]  ->  Epson  FX-100  Printer,  CRT  Graphics  I’,/, 

+  15X,’[15J  -»  Epson  FX-100  Printer,  plotter  graphics',/, 

+  1 5X , ' [ 16 ]  ->  Epson  FX-100  Printer,  CRT  Graphics  XI’,/, 

♦  15X , * [ 20 ]  ->  HP  7170A  Graphics  Plotter',/, 

♦  15X,’[30]  ->  HP  7175A  Graphics  Plotter’,/, 

+  1 5X . ' [ 60 J  ->  HP  2686A  Laser  Jet  Printer  (NPS  installation)',/, 

+  15X,’[Q]  -->  QUIT  THIS  MENU’ .//, 

+  3X, ’Enter  Printer  Selection  Integer  or  Q  to  QUIT  - >  ’,\) 

230  formate 12X, ’***  MOTOR  PARAMETER  SETTINGS  MENU  ***’,//, 

+  1X.F12.7, IX, ' tKT)  Motor  Torque  Constant',/, 

♦  1X.F12.7, IX. ' [KB]  Motor  Back  EMF  Constant',/, 

+  IX , F12. 7 , IX, ' [R]  Motor  Equivalent  Resistance  (ohms)’./, 

+  IX, F12 . 7 , IX, • [L]  Motor  Inductance  (henries)',/, 

+  1X.F12 . 7 , IX, ' [ J]  Motor  Inertia  (oz-in/s*2 )’,/, 

+  1X.F12. 7, IX, ’ [F]  Motor  Viscous  Friction  Coeff',/, 

+  1X.F12. 7 , IX, ’ tKP]  Motor  Position  Feedback  Constant’,/, 

+  1X.F12.7.1X, ' tKV]  Motor  Velocity  Feedback  Constant’,/, 

+  15X, II , IX, ’ [SYSORD]  System  Order  (2“Reduced; 3-Linearized) ’ , / , 

+  17X , ’ [Q1  QUIT  THIS  MENU' ,//. 

+  IX, ’Enter  variable  name  (UPPERCASE)  or  Q  to  QUIT  - >  ',\) 

C 

210  format ( 12X , ’ ***  SIMULATION  OPTIONS  MENU  ***’,//, 

+  IX, F 15. 7 ,  IX, ' (BEGTIM)  Start  Time  of  Plotting  Window’,/, 

+  1X.F15.7.1X, ’ 1FINTIM]  Stop  Time  of  Plotting  Window',/, 

+  1X.F15 . 7 , IX, ' [MAXITS J  Max  Number  of  Simulation  Iterations',/, 
+  13X.I3.1X, ’ [SIM2FL]  Ratio:  Points  Simulated/Plotted',/, 

+  1X,F15.7,1X. ’ [E0]  Initial  Fin  Position  (deg)',/, 

+  1X.F15.7.1X, 1 [EDOT01  Initial  Fin  Velocity  (deg/s)’,/, 

+  1X.F15 . 7 , IX, ' [XORG]  X  Coordinate  of  Plotting  Origin’,/, 

+  1X.F15 . 7 , IX , ' [ YORG]  Y  Coordinate  of  Plotting  Origin’,/, 

+  17X , ' [Q]  QUIT  THIS  MENU’,///, 

+  15X, 'Computed  simulation  step  size  - >  ’,F9.8,  ’seconds',/, 

+  15X, ’Computed  total  number  of  steps - >  ’,15,//, 

+  lX.’Enter  variable  name  (UPPERCASE)  or  Q  to  QUIT  - >  ’,\) 

C 

215  format(12X, '***  COWAND  INPUT  SELECTION  MENU  ***',//, 

+  1X.A15.1X, ’ [TYPE]  STEP,  RAMP,  or  SINE  Response’ ,/ , 

+  1X,F15.7,1X, ' [STIWAGJ  Conmanded  Position  for  STEP  Response’,/ 
+  1X.F15.7.1X, ' [RSLOPE]  Slope  of  RAMP  Function',/, 

+  1X.F15.7.1X, ' [SINAMP]  Amplitude  of  SINE  Function’,/, 

+  1X.F15, 7, IX, ' (SINFRQ)  Frequency  (deg/sec)  of  SINE  Function’,/ 
+  IX , F15 . 7 , IX , 1 [SINPHA]  Phase  Angle  (deg)  of  SINE  Function’,/, 

+  17X , 1 [Q]  QUIT  THIS  MENU’,///, 

+  IX, ’Enter  variable  name  (UPPERCASE)  or  Q  to  QUIT  - >  ’ , \ ) 

C 

270  format ( / / / , 8X , ’ ***  NON-LINEAR  ELEMENT  SELECTION  ***’,//, 


277 


+  10X , ’ [R]  Relay  (Bang-Bang)’./, 

+  10X,’[P]  Pulse  Width  Modulator’,/, 

+  10X , ’ [ A]  Amplifiar  (Saturating)’,/, 

+  lOX.'tQ]  QUIT  THIS  MENU /RETURN  TO  MAIN  MENU',//, 

+  IX. ’Enter  Selection  >  ’.\) 

C 

272  format ( 10X , ' CURRENT  SELECTION  -->  \A30) 

C 

280  format ( / / / , 8X , ' *»*  SATURATING  AMPLIFIER  SPECIFICATIONS  ***',//, 

+  IX, F15 . 7 , IX , ' [DBAND]  Deadband  Applied  to  System  Feedback’, /, 

+  1X.F15.7.1X, ’ [KA]  Amplifier  Gain',/, 

+  17X, ’ C Q 3  QUIT  THIS  MENU’,//, 

+  IX, 'Enter  the  selection  (UPPERCASE)  - >  ' , \ ) 

C 

290  format ( / / / , 15X , ’ ***  RELAY  SPECIFICATIONS  ***',//, 

♦  1X.F15. 7, IX, ' [DBAND]  Deadband  Applied  to  System  Feedback',/, 

+  17X , ' [Q3  QUIT  THIS  MENU',//, 

+  IX, 'Enter  the  selection  (UPPERCASE)  — »  ’,\) 

C 

300  format ( / / / , 5X, ' ***  PULSE  WIDTH  MODULATOR  SPECIFICATIONS  »**',//, 
+  IX, F15 . 7 ,  IX, ' IDPANEj  Deadband  Applied  to  System  Feedback’,/, 

+  1X.F15.7.1X, ' [PERIOD]  Period  of  WM  Reference  Cycle(sec ) ’ , / , 

+  1X.F15.7.1X, ’ [KPWM]  PWM  Amplifier  Gain’ ,/, 

+  17X,  '  [Q]  QUIT  THIS  MENU’,//, 

+  IX, 'Enter  the  selection  (UPPERCASE)  - »  ’,\) 

C 

1200  format(20X. 'LINEAR  MODEL  OF  BRUSHLESS  DC  MOTOR',//, 

+  1SX.I1.1X, ’ [SYSORD]  System  Order  (2-Reduced; 3-Linearized) ' , / , 

+  1X.F15. 7 , IX, ’ [BEGTIMJ  Start  Time  of  Plotting  Window'./, 

*  1X.F15 . 7 , IX, ' [FINTIMJ  Stop  Time  of  Plotting  Window',/, 

+  IX, FIS. 7, IX, ' [MAXITS]  Max  Number  of  Simulation  Iterations’,/, 

+  13X.I3, IX. ' [SIM2PL]  Ratio:  Points  Simulated/Plotted’,/, 

+  4X.F12. 7, IX, ’ [KT]  Motor  Torque  Constant',/, 

+  4X.F12.7.1X, ' [KB]  Motor  Back  EMF  Constant’,/, 

+  4X.F12 . 7 , IX, ' [R]  Motor  Equivalent  Resistance  (ohms)’,/, 

+  1X.F12 . 7 , IX, ’ [L]  Motor  Inductance  (henries)’,/, 

+  *X ,F12 . 7 , IX , ’ [ J]  Motor  Inertia  (oz-in/s*2) ’ , / , 

+  1X.F12. 7, IX, ’ [F]  Motor  Viscous  Friction  Coeff’,/, 

+  4X.F12. 7 , IX, ’ [KP]  Motor  Position  Feedback  Constant’,/, 

+  4X.F12.7.1X, ' [KV]  Motor  Velocity  Feedback  Constant',/, 

+  IX , F12 . 7 , IX , ' [KA]  Saturating  Amplifier  Gain  (if  used)',/, 

+  4X,F12.7,1X, ’ (PERIOD]  Period  of  PWM  Reference  Cycle',/, 

+  *X,F12. 7, IX, ’ [DBAND]  Position  Feedback  Deadband’,/, 

+  1X,F15.7,1X, ' [E0]  Initial  Fin  Position  (deg) ',/ , 

+  IX, FIS. 7, IX, ' [EDOTO]  Initial  Fin  Velocity  (deg/s)’) 

1201  format(lX,A15,lX, ’ [TYPE]  STEP,  RAMP,  or  SINE  Response’ ,/ , 

+  IX , F15 . 7 , IX, ’ [STPMAG]  Commanded  Position  for  STEP  Response’,/, 
+  1X.F15.7, IX, ’ [RSLOPE]  Slope  of  RAMP  Function’ ,/ , 

+  1X.F15  7, IX, ’ [SINAMP]  Amplitude  of  SINE  Function’,/, 

+  1X.F15  7, IX, ’ (SINFRQJ  Frequency  (deg/sec)  of  SINE  Function',/, 
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♦  1X.F1S.7. IX. ' ISINPHA]  Phase  Angle  (dag)  of  SINE  Function') 
1205  FORMAT (1X,F86,1X,1P5E123) 

1300  FORMAT( /////, 2X Tha  following  ara  plotting  options',//, 

+  5X,'[1)  FIN  POSITION  rasponaa',/, 

♦  5X,'[2]  FIN  VELOCITY  rasponsa',/, 

+  5X,'[3]  MOTOR  CURRENT  rasponsa',/, 

+  5X.‘[Q]  QUIT  THIS  MENU',//, 

♦  2X,’Entar  salaction  11, Q)  - >  ’,\) 

C 

1305  FORMAT(///// ,2X, 'Display  options:1,/, 

♦  5X , '  CM]  MONITOR' ,/. 

♦  5X , ’ [P]  PRINTER' ,/. 

♦  5X . ' [ R ]  RETURN  TO  START-UP  MENU  (RE- INITIALIZE )',/ , 

♦  5X,'[S]  SAVE  SIMULATION  SPECIFICATIONS  TO  DISK',/, 

♦  5X . ' [ Q ]  QUIT  THE  PROGRAM',//, 

♦  2X,'Entar  salaction  [1,2,3,Q]  - >  ’,\) 

C 

1500  formate  IX, 13 , 2X , A50 ) 

C 

STOP 

END 

C . - . — . 

C 

c  *****  PLOTTING  SUBROUTINES  ***** 

C  *****(alngla  function  plot)***** 

C  •*************«*••**..•...*.**** 

Subroutine  GRAPHtX.Y ,XORG,YORG, DISOPT) 

C 

implicit  REAL**  (A-Z) 

COWION  BEGTIM ,  FINTIM ,  NPTS ,  IOPORT ,  MODEL ,  XLEN ,  YLEN ,  PLEN ,  PLEN1 , 

+  XTITLE,YTITLE,PTITLE,PTIT1 

real**  X< 1010 ) ,Y( 1010 ) 

integer*2  NPTS , IOPORT , MODEL , XLEN , YLEN , NCHAR , NCHAR1 
character*l  DISOPT.ANS 
charactar*25  XTITLE , YTITLE 
charactar*51  PTITLE.PTITl 
C 

C  ...  Moke  a  new  title. . . 

5  call  CLRSCR 

if  ((DISOPT  ,aq.  'P')  .or.  (DISOPT  ,eq.  ’p'))  than 
call  GOTOXY (8,30) 
writaC*,*)  'Currant  Title  is:' 
call  GOTOXY (10,20) 
writaC*,*)  PTITLE 
call  GOTOXY (11,20) 
writa(*,*)  PTIT1 
call  GOTOXY (15,25) 

write(* , ' (A\ ) ' )  'Do  you  want  to  change  tha  title?  ’ 
raad(*. ' (A) ’ )  ANS 
call  CLRSCR 


279 


if  ((ANS  .  eq.  'Y')  .or.  CANS  .  eq  'y'))  then 
call  GOTOXY ( 5 , 10) 

write!*,*)  'Enter  titles  in  laft  justified  format’ 
call  GOTOXY ( 12,10) 

writs ( * , * )  ' 1231 567 890 1231 567890 1231 567890 1234 56 7 890 123 4 56 7 890 ' 
call  GOTOXY (13, 10) 

writat*,*)  •  12345’ 

call  GOTOXY (15,25) 
writ e(*,*)  ’#  of  characters  --»• 
call  GOTOXY (20, 10) 

write!*, *)  ’ 12345678901231567890123156789012345678901231567890' 
call  GOTOXY (21. 10) 

write!*,*)  ’  12315’ 

call  GOTOXY (23,25) 
wnte(*,*)  ’#  of  characters 
call  GOTOXY ( 11,11) 
read( * , ’ (A51 ) ’ )  PTITLE 
call  GOTOXY ( 15,16) 
read (* , * )  PLEN 

call  GOTOXY (19,11) 
read(* . ‘ (A51)' )  PTIT1 
call  GOTOXY (23,16) 
read(* , * )  PLEN1 

•lseif  ((ANS  .eq.  ’N')  .or.  (ANS  .eq.  ’n’))  then 
go  to  10 
end  if 
go  to  5 
and  if 
C 

10  call  GOTOXY (10,25) 

writat*,*)  'Calculating  Plotting  Data’ 

C 

ASFRAT-.65 

CHARHT-.22 

CflARHl-,20 

PTX- . 5+( 6 . -PLEN*ASPRAT*CHARHT )/2. 

PTY-1 . 5 

PTX1- . 5+( 6 . -PLEN1«ASPRAT*CHARH1 ) /2 . 

PTY 1-1.1 

NCHAR-i fix (PLEN) 

NCHARl-ifix(PLENl) 

C 

call  PLOTS (O.IOPORT, MODEL) 
call  FACTOR! 1,00) 
call  ASPECT (ASPRAT) 

C  ...  Draw  a  Border 

if  ((DISOPT  .eq.  ’ P ’ )  or  (DISOPT  .eq.  ’p’))  then 
call  PLOT(XORG,YORG,-13) 
call  PLOT ( 8 . 0 , 0 . 0 , 2 ) 
call  PLOT ( 8 . 0 , 6 . 0 , 2 ) 
call  PLOT ( 0 . 0 , 6 . 0 . 2 ) 
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call  PLOT ( 0 . 0 , 0 . 0 , 2 ) 
call  PLOT (1.25.1. ,-13) 

elseif  ((DISOPT  eq.  ’M' )  or.  (DISOPT  eq.  'm'))  then 
call  PLOT ( 1 . ,1. .-13) 


.  This  scaling  applies  when  the  X  axis  represents  Time 
X(NPTS+1)-BEGTIM 
FIRSTX  -  X  CNPTS+1 ) 

X ( NPTS+2 )-(X(NPTS )-X(NPTS+l))/6. 

DELTAX  -  XCNFTS+2) 


call  SCALE ( Y ,  *  . .NPTS.l) 

FIRSTY  -  Y(NPTS+1 ) 

DELTAY  -  Y( NPTS+2) 

call  STAXIS(.15, .22, .12, .080,3) 

call  AXIS(0.0,0.0.XTITL£,XLEN,6. ,r  , FIRSTX, DELTAX) 

call  STAXISC.15, .22, .12, .080,2) 

call  AXIS(0. ,0. , YTITLE , YLEN , * . , 90 . .FIRSTY, DELTAY) 

call  SYMBOL ( PTX, PTY.CHARHT, PTITLE, 0. ,NCHAR) 

call  SYMBOL ( PTX  1 ,  PTY1 ,  CHARH1 ,  PTIT1 , 0  .  , NCHAR1 ) 

call  LINE(X,Y, NPTS, 1,0,0) 

call  PLOT ( 0 . ,0. ,999) 

MODEL-99 
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******************************** 
*****  PLOTTING  SUBROUTINES  ***** 


(multi-function  plot)* 


Subroutine  MGRAPH (X . Y , Z , XORG , YORG .DISOPT ) 
implicit  REAL**  (A-Z) 

COPMON  BEGTIM, FINTIM, NPTS , IOPORT , MODEL ,XLEN , YLEN , FLEN , PLEN1 , 
+  XTITLE, YTITLE, PTITLE, PTIT1 

real**  X( 1010 ), Y( 1010 ), Z( 1010 ) 

integer»2  NPTS, IOPORT , MODEL , XLEN , YLEN , NCHAR , NCHAR1 
character*l  DISOPT, ANS 
charecter*25  XTITLE , YTITLE 
character*51  PTITLE, PTIT1 


Make  e  new  title . . . 
call  CLRSCR 

if  ((DISOPT  eq.  'P')  .or.  (DISOPT  eq.  'p'))  then 
call  GOTQXY (8,30) 
write(*,*)  'Current  Title  i*:' 
call  GOTOXY (10,20) 
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write(  * . * )  PTITLE 
cell  GOTOXY  (11,20) 
wntet* .  * )  PTIT1 
call  GOTOXY (15.25) 

write(* , ' (A\ ) ’ )  'Do  you  want  to  change  the  title?  ' 
read( * , ' (A) ' >  ANS 
call  CLRSCR 

if  ((AMS  eq  'Y')  or  (ANS  eq .  'y'))  then 
call  GOTOXY<  5, 10) 

write(*,*)  ‘Enter  titles  in  left  justified  format' 
call  GOTOXY (12,10) 

writef  *  ,  *  )  '  1234 567890 1231 567 890 1234 567890 1231 567890123'. 567890' 
call  GOTOXY (13,10) 

writa (* , *)  '  12345' 

call  GOTOXY (IS, 25) 
write(*,»)  '#  of  characters  — >' 
call  GOTOXY ( 20 , 10) 

writa(*,*)  '12345678901234567890123456789012345676901234567890' 
call  GOTOXY (21,10) 

write(* , * )  '  12345' 

call  GOTOXY (23, 25) 
write(*,*)  *#  of  characters  --»• 
call  GOTOXY (11,11) 
read(* , ’ (A51 ) ' )  PTITLE 
call  GOTOXY (15,46) 
read(* , * )  PLEM 

call  GOTOXY (19,11) 
read(*. ' (A51)' )  PTIT1 
call  GOTOXY (23,46) 
read(*,*)  PLEN1 

alself  ((ANS  .eq.  'N’>  .or.  (ANS  eq.  'n’)>  then 
go  to  10 
end  if 
go  to  5 
endif 
C 

10  call  GOTOXY (10,25) 

write(*,#)  'Calculating  Plotting  Data' 

C 

AS PRAT-. 65 
CHARHT-.22 
CHARH1-  20 

PTX-0 . 5+(6  -PLEN*ASFRAT*CHARHT)/2 
PTY-4 . 5 

PTX 1-0 . 5+ ( 6 . - PLEN 1 * AS PRAT *CHARH 1 ) / 2 
PTY1-4  1 

NCHAR-iflx(PLEN) 

NCHAR 1-1  fix  (  PLEN  1 ) 

call  PLOTS ( 0, IOPORT, MODEL) 
call  FACTOR (1  00) 


282 


call  ASPECT (AS PRAT) 


C  .  Draw  a  Bordar 

if  (tDISOPT  .eq.  'P')  or.  (DISOPT  eq  'p'))  than 
call  PL0TCXQRG.Y0RG.-13) 
call  PLOT ( 8 . 0 , 0 . 0 . 2 ! 
call  PLOT ( 8 . 0 , 6 . 0 , 2 ) 
call  PLOT ( 0 . 0 , 6 . 0 , 2 ) 
call  PLOT ( 0 . 0 , 0 . 0 , 2 ) 
call  PLOT (1.25,1. ,-13) 

elsaif  ((DISOPT  .aq.  'M’ )  or.  (DISOPT  .eq.  ‘m’))  then 
call  PLOT ( 1 . ,1. , -13) 
end  if 
C 

c 

C  ...  This  scaling  applies  when  the  X  axis  represents  Time... 
X(NPTS+1)-BEGTIM 
FIRSTX  -  X(NPTS+1) 

X(NFTS+2)-(X(NPTS)-X(NPTS+l))/6 
DELTAX  -  X( NPTS+2) 

C 

call  SCALE ( Y , 4 . , NPTS , 1 ) 
call  SCALE ( Z ,  4  . , NPTS , 1 ) 
if  (Z(NPTS+2)  .gt.  Y( NPTS+2) )  then 
Y( NPTS+2 )-Z< NPTS+2) 

else 

Z ( NPTS+2 ) “Y ( NPTS+2 ) 
endif 

FIRSTY  -  Y(NPTS+1) 

DELTAY  -  Y( NPTS+2) 

C 

call  STAXIS( .15, .22, .12, .080,3) 

call  AXISCO .0,0,0 ,XTITLE , XLEN , 6 . ,0. .FIRSTX, DELTAX) 
call  STAXIS(.15, .22, .12, .080,2) 

call  AXIS(0. ,0. , YTITLE , YLEN , 4 . ,90. , FIRSTY , DELTAY ) 
call  SYMBOL ( PTX , PTY .CHARBT , PTITLE , 0 . , NCHAR) 
call  SYMBOL! PTX  1 ,  PTY1 ,  CHARH1 ,  PTIT1 , 0  .  ,  NCHAR1 ) 
call  LINE(X,Y, NPTS, 1,0,0) 
call  CURVE (X , Z , NPTS , * . 1 ) 
call  PLOT ( 0 . , 0 . ,999) 

C 

MODEL-99 
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return 

end 


PULSE  WIDTH  MODULATOR  MODULE 


Subrout  me  PWMOD(TIME  .  NUMIT  .  TSTART  .  PERIOD  .  TOGGLE  .  POSERR  , 
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DBAND  ,  VI N  .  VREF  .  THRESH  ,  KIWI ) 


IMPLICIT  REAL**  (A-Z) 
INTEGER* 2  NUMIT.DIR 
L0GICAL*2  WAITNG. TOGGLE 


Reset  the  saw-tooth  reference  signal 
if  (TIME  .ga  TSTART+PERIOD)  then 
TSTART-TSTART* PERIOD 
TOGGLE- . trua . 
and  if 


if  (POSERR  .gt.  ( 0 . +DBAND ) )  then 
DIR-1 

ERROR- ab  s  (KPtM*  (  POSERR -DBAND) ) 
elseif  (POSERR  .It  (0. -DBAND))  then 
DIR— 1 

ERROR-abs  ( KPVW*  ( POSERR+DBAND  )  ) 
elae 

ERROR- 0 . 
end  if 

call  LIMIT(0. ,1. .ERROR, ERROR) 
call  RAMP(TIME,TSTART,NR£F) 
VREF-NREF/ PERIOD 
THRESH- 1 . -ERROR 


"WAITING"  is  a  logical  variable  indicating  whether  or  not  a  new 
pulse  may  be  generated 
if  (NUMIT  .eq.  1)  WA I TNG-TOGGLE 

if  (WAITNG)  then 

if  (VREF  gt.  THRESH)  then 
if  (DIR  eq.  1)  then 
VIN-150. 

TOGGLE-. false, 
elseif  (DIR  .eq.  -1)  then 
VIN— 150. 

TOGGLE-. false, 
endif 

elseif  (VREF  .It.  THRESH)  then 
VIN-0 . 

TOGGLE- . true . 
endif 
endif 


return 

end 


RELAY  MODULE 


«.  %  S  *.  S  5. 


Subrcut  me  RELAY  (  POSERR .  DBAND .  VIN ) 


implicit.  REAL**  (A-Z) 


if  (POSERR  gt  DBAND)  then 


elseif  (POSERR  It  -DBAND)  than 


elseif  (abs( POSERR)  le  DBAND)  then 


SATURATING  AMPLIFIER  MODULE 


Subroutine  AMPLIF ( POSERR, DBAND , KA, VIN ) 


implicit  REAL+A  (A-Z) 


if  ( abs ( POSERR)  . le .  DBAND)  then 


elseif  ( ( ( ’"'OSERR-DBAND )  *KA  .gt.  0.)  .and. 

((POSERR-DBANDl+KA  .It.  l.)>  then 
VIN-150 . *(POSERR-DBAND)*KA 
elseif  ( ( ( POSERR+DBAND ) +XA  .it.  0.)  end. 

( (POSERR+DBAND >*KA  . gt .  -l.)>  then 
VIN- 1 50 . * ( POSERR+DBAJTO ) *KA 
elseif  ( (POSERR-DBAND)*KA  ,ge.  1.)  then 


elseif  ( (POSERR+DBAND )*KA  .le.  -1.)  then 
VIN— 150  . 


Cutof f-Seturetion  Limiting  Subroutine 


Subroutine  LIMIT (RSAT , RCUT . INPUT . OUT ) 
implicit  REAL**  (A-Z) 
if  (INPUT  le  RSAT)  then 


elseif  (INPUT  «e  RCUT)  then 


OUT-INPUT 
•nd  if 


return 

end 


Function  Switch  Subroutine 


Subroutine  FCNSW ( X 1 . X2 . X3 , X 4 , OUT ) 
implicit  REAL-1  (A -Z) 
if  (XI  .It.  0  0)  then 
0UT-X2 

elseif  (XI  .  eq.  0.0)  then 
0UT-X3 

else 

OUT-Xl 
end  if 

return 

end 


Step  function  Subroutine 


Subroutine  STEP ( TIME. TSTEP, OUT) 
implicit  REAL-1  (A'Z) 
if  (TIME  ge  TSTEP)  then 
OUT- I  0 

•  lee 

OUT-O  0 
•nd  if 


return 

end 


*****  Deedepece  Subroutine  ***** 


Subroutine  DEADSP ( PI . P2 . VSGDEL , VSGERR) 
implicit  REAL*i  (A-Z) 
if  (VSGDEL  gt  P2)  then 
VSGERR- VSGDEL - P2 
elseif  (VSGDEL  It  PI!  then 
VSGERR-VSGDEL-P1 
else 

VSGERR-0  0 
•nd  1  f 


return 

•nd 


Remp  Subroutine 


Subroutine  RAMP.  TIME.  TRAMP,  OUT) 


implicit  REAL*!  (A'Z) 
if  TIME  ge  TRAMP)  then 
OUT-TIME- TRAMP 
■  Is* 

OUT-C  C 
•  nd  1  f 


return 


end 


***  TIME  CONSTANT  *** 


Subroutine  TCONST(YO , X , TAU , NTIME , NTIM, DELTIM, Y) 
implicit  reel**  (A-Z) 
mteger*2  NTIME, NTIM 
if  (NTIME  ne.  NTIM)  YO-Y 
DECAY-exp( -DELTIM/TAU) 

Y-Y0f(X-Y0)*(l. -DECAY) 
if  (NTIME  .eq.  1)  Y-YO 
NTIM-NTIME 


return 

end 

********************************************* 
*****  First  Order  Derivative  Subroutine  ***** 


Subroutine  DERIV(DELTIM, NTIME , NTIM1 , IC2 , XM1 . NOWVAL ] XX , XDM1 , 
XD,XDDM1,XDD, SLOPE) 
implicit  REAL**  (A-Z) 
integer*2  NTIME, NTIM1 

if  (NTIME  .eq.  NTIM1)  then 
XX-NOWVAL 
else 
XM1-XX 
XX-NOWVAL 
XDM1-XD 
XDDM1-XDD 
end  if 


XD-(XX-XMl) /DELTIM 
if  (ahs(XD)  It  1  I; -  ?  XI  - 
lf  (NTIME  eq  1'  XD-ITl 
XDD- CXD-XDMi  ’  C1" 
if  (  abs  ( XDC  '  -  ■ 

NT IMI-NT IME 


if  (abs(XPRED)  .It.  l.E-8)  XPRED-0.0 

SL0PE-(XPRED-XM1 ) / (2 . 0*DELTIM) 

if  ( abs ( SLOPE )  .It.  l.E-8)  SLOPE-O.O 


rttum 

•nd 


*****  Trapazoidal  Integration  Subroutin# 


Subroutina  INTGRL ( NTIME . NTIM2 , DELTIM , IC3 , PREVAL , NOWVAL , 
+  CURVAL ,  OUTOLD ,  OUTNEW ) 

implicit  REAL**  (A-Z) 
integer*2  NTIME, NTIM2 

if  ((NTIME  .aq.  NTIM2)  .or.  (NTIME  .aq.  1))  than 
CURVAL-NOWVAL 

alsa 

PREVAL  -  CURVAL 
CURVAL  -  NOWVAL 
OUTOLD  -  OUTNEW 
and  if 

if  (NTIME  .aq.  1)  0UT0LD-IC3 

OUTNEW  -  0UT0LD+(CURVAL+PREVAL)«DELTIM/2. 

NTIM2-NTIME 


rttum 

and 

***********»*#**#********»*»**#it]t*»»it**# 

*****  CLEAR  SCREEN  AND  HOME  CURSOR  ***** 


subroutina  CLRSCR 
charactar*l  C1,C2,C3,C* 
integar*2  IC(*) 

aquivalanca  (C1,IC(1) ) , (C2, IC(2) ) , (C3,IC(3) ) , (C4 ,IC(* ) ) 
data  IC/lSflB, 16#5B, 16*32, 16#*A/ 

***  Writa  Eacapa  Coda  to  Display  *** 
write(*,l)  C1,C2,C3,C* 

1  format ( LX , *A1 ) 

return 

and 


Position  Cursor  by  Row, Column 


subroutina  GOTCKYt ROW, COLUMN) 
intagar*2  IC (*), ROW , COLUMN , L 
charactar*l  C1,C2,C5,C8,LC(5) 
eharactar*5  CBUIT 

aquivalanca  (Cl,  IC(1)  > ,  (C2,  IC(2) ) ,  (C5,  ICO) ) ,  (C8,  IC(*) ) , 
+  ( CBUFF , LC ( 1 ) ) 


data  IC/16#1B, 16#5B, 16#3B, 16*66/ 


PHASE  PLANE  ANALYSIS  PROGRAM 


SNOfloetcalls 

SNOdebug 

C 

c  _ 

Cl  I 

C  |  ROSSITTO,  VS  THESIS  PROF  GERBA  03/25/87  | 

C  | _ PHASE_PLANE_DESIGN_MODEL _ | 

C 

C  This  program  computes  and  plots  the  characteristic  slope  markers 

C  for  the  reduced  order  Brushless  DC  Motor  model.  Motor  parameters 

C  are  provided  by  the  user.  Additionally,  the  Non-Linear  Element 

C  performance  is  plotted.  Step  and  Ramp  responses  may  be  analyzed. 

C  Plotting  density  is  selectable  (lOOOpts/plt  max). 

C 

IMPLICIT  REAL**  (A-Z) 

CC***)N  XTIME ,  Y1 ,  Y2 ,  Y3 .  Y* ,  BEGTIM ,  FINTIM ,  NPTS ,  IOFCRT .  MODEL , 

♦  XLEN , YLEN , PLEN , PPLANE .XTITLE , YTITLE , PTITLE 

REAL**  Xt 1010 ). Yt 1010), Ylt 1010), Y2t 1010 ),Y3t 1010 ),Y*t 1010), 

♦  XTIME  ( 1010 ) 

INTEGER* 2  NTERMS , IOPORT, MODEL , XLEN , YLEN. NTIME.mJMIT .NTIMl , 

+  NTIM2 ,  NTIM3 ,  NTIM*  ,  DIR ,  FMOOEL  ,  NPTS .  NCTR ,  PPLANE .  PTSPL1 . 

+  SIM2PL ,  ECTR ,  EDCTR ,  NUMBER ,  NDIM ,  CTR ,  ELEMNT ,  PTSPLT  ,  VCTR 

LOGICAL*2  WAITNG, TOGGLE 
CHARACTER*1  DISOPT.PL0PT 

CHARACTER*6  ANSI , ANSI 1 , ANS21 , ANS27 , PRTSEL , NONLIN 
CHARACTER*25  XTITLE , YTITLE 
CHARACTER* 2 5  NLCHAR 
CHARACTER* 51  PRTCHR, PTITLE 
C 

C  ...  Introductory  Page  (1  time  good  deal!) 
call  CLRSCX 
write<*,*) 

PAUSE 

C  *************************************** 

C  «««  OPEN /READ /CLOSE  INPUT  DATA  FILE  *»* 

C  *********•**••**•••******••****••***••• 

c 

13  open ( 7 , FILE- ' PHPLANE . INF ' , STATUS- ’ OLD ’ , ACCESS- ' SEQUENTIAL ’ ) 

reed (7, 1000)  FMOOEL , PRTCHR 
read (7 , 1020 )  BEGTIM , FINTIM , MAXITS , SIM2PL 
read! 7, 1022)  KPWM,KV,EO,EDOTO 
readt  7 , 102* )  R,L ,  J,F ,KT , KB , KP 
read (7, 1026)  RSLOPE , PERIOD , DBAND 
readt  7 , 1026)  KA, PTSPLT , XORG , YORG ,WF ACT 
read ( 7 , 1030 )  EMIN ,  ZMAX , EDMIN , EDMAX 
closet  7 , STATUS— ’ KEEP’ ) 


c 

c 

c 


•**  DISPLAY  MAIN  MENU  SELECTIONS  *•* 


ta 


call  CLRSCR 
call  GOTQXYC8 , 1) 
write(*,5) 
read(*, ' (A) 1 )  ANSI 
.  Hardware  Options  . . . 

if  ((ANSI  .eq.  'h' )  .or.  (ANSI  ,aq.  *H'>)  than 


call  CLRSCR 
call  GOTOXY (17,24) 

write (*,*)'••*  CURRENT  PRINTER  SELECTION  •**' 

call  GOTOXY (20,20) 

write(»,»)  FRTCHR 

call  GOTOXY (10,1) 

write(*,103) 

read(«,'(A)')  ANS11 


I 


Printer  Options  . . . 

if  ( (ANS11  .eq.  ’p')  .or.  (ANS11  .eq.  'P‘)>  then 
call  CLRSCR 
write(*, 130) 
read(*, ’ (A) * )  PRTSEL 


if  (PRTSEL  .eq.  ’O')  then 

FRTCHR" ' Epson  FX-80  Printer,  single  density' 
MOOEL-O 

elseif  (PRTSEL  .eq.  '1')  then 

FRTCHR- ' Epson  FX-80  Printer,  double  density' 

MODEL"  1 

elseif  ( PRTSEL  .eq.  *2')  then 

PRICER” ' Epson  FX-80  Printer,  dble  spd.dual  density' 
MODEL-2 

elseif  (PRTSEL  .eq.  '3')  then 

FRTCHR- ’ Epson  FX-80  Printer,  quad  density' 

MODEL-3 

elseif  (PRTSEL  .eq.  '*')  then 

FRTCHR- 'Epson  FX-80  Printer,  CRT  Graphics  I’ 
MODEL-* 

elseif  (PRTSEL  .eq.  *3’)  then 

FRTCHR-' Epson  FX-80  Printer,  plotter  (rsphics' 
MODEL- 5 

elseif  (PRTSEL  .eq.  *8')  then 

FRTCHR-' Epson  FX-80  Printer,  CRT  Graphics  II' 
PMOOEL-6 

elseif  (PRTSEL  .eq.  '10')  then 

FRTCHR- 'Epson  FX-100  Printer,  slnfle  density' 

MOO  EL-7 

elseif  (PRTSEL  .eq.  'll’)  then 


m 


PRTCHR- 'Epaon  FX-100  Printer,  double  denaity' 
PMODEL-11 

alaaif  (PRTSEL  .aq.  '12')  then 

PRTCHR- 1 Epaon  FX-100  Printer,  dble  apd.dual  denaity' 
FMODEL-12 

aliaif  (PRTSEL  . aq.  '13')  than 

PRTCHR- 1 Epaon  FX-100  Printar,  quad  denaity' 

FMODEL-13 

alaaif  (PRTSEL  .aq.  '14‘)  than 

PRTCHR-’Epaon  FX-100  Printar,  CRT  Graphica  I' 
MODEL-14 

alaaif  (PRTSEL  .aq.  '15’)  than 

FRTCHR-'Epaon  FX-100  Printar,  plottar  graphica' 
PMODEL-15 

alaaif  (PRTSEL  .aq.  '16')  then 

PRTCHR- 'Epaon  FX-100  Printer,  CRT  Graphica  II’ 
MODEL-16 

alaaif  (PRTSEL  .aq.  '20  than 

PRTCHR- 'HP  7«70A  Graphica  Plotter' 

PM0DEL-20 

alaaif  (PRTSEL  aq.  ’30')  than 

PRTCHR- 1  HP  7475A  Graphica  Plotter' 

FMODEL-30 

alaaif  (HITSEL  .aq.  *60’)  than 

PRTCHR- ’HP  2686A  Laaar  Jet  Printer' 

PMDDEL-60 

Quit  the  Printar  Menu  . . . 

alaaif  ((PRTSEL  .aq.  'Q’ )  .or.  (PRTSEL  .aq.  ’q’))  than 
go  to  101 

elae 

go  to  131 

endif 

go  to  101 

Quit  the  Hardware  Menu  . . . 

alaaif ( (AHS11  .aq.  ’q’)  .or.  (AHS11  .aq.  ’Q’))  than 

go  to  1 

alaa 

go  to  101 
endif 

Motor  Parameter*  . . . 

alaaif  ((ANSI  .aq.  'a')  or.  (ANSI  .aq.  ’M’))  than 
call  CLRSCR 

write!* , 230 )  KT , KB ,R ,L , J , F , KP ,KV 
read!*, ’(A)' )  ANS21 


if  (AHS21  .aq.  'XT’)  than 
call  GOTOXY (2a, 1 ) 


.‘0 

V 

$ 


l 


I A 

C 


J 


I'i 

a 

.1 


writa(*, ‘ (A\ ) * ) ‘Enter  a  REAL 
raad(* , * )  KT 
go  to  201 

alaaif  (ANS21  .aq.  ’KB*)  than 
call  GOTOXY (24,1) 
wtlta(», * (AV ) ’ ) ‘Entar  a  REAL 
raad(*,»)  KB 
go  to  201 

alaaif  (AHS21  aq.  -R* >  than 
call  GOTOXY (24 , 1 ) 
writa(*, ' (A\ ) * ) 'Entar  a  REAL 
raad(*,*)  R 
go  to  201 

alaaif  (ANS21  .aq.  'L')  than 
call  GOTOXY(24,l) 
writat* , ' <A\ ) ’ ) ‘Entar  a  REAL 
raad(*,*)  L 
go  to  201 

alaaif  (ANS21  .aq.  'J‘>  than 
call  GOTOXY (24 , 1) 
writa(», ' (A\ > ' ) ‘Entar  a  REAL 
r aad ( * , * )  J 
go  to  201 

alaaif  (AHS21  .aq.  'T' )  than 
call  GOTOXY (24 , 1) 

»rita(« , ' (A\ ) ' ) ‘Entar  a  REAL 
raad<*,*)  F 
go  to  201 

alaaif  (AKS21  .aq.  ‘KP’ )  than 
call  GOTQXY(24 , 1) 
wrlta<«, ■ (A\)' I’Eotar  a  REAL 
raad(*,*)  KP 
go  to  201 

alaaif  CAHS21  .aq.  'XT')  than 
call  GOTOXY (24 , 1) 

«*rlta<*. '  (A\ )  ’ )  'Entar  a  REAL 
raad<».*>  XV 

go  to  201 

Quit  Motor  Paraoatara  Manu  . . . 

alaaif  (ANS21  .aq.  'Q' )  than 
go  to  1 

alaa 

go  to  201 


HOW -LI REAR  ELEMENT  SELECTION  MENU 

alaaif  ((ANSI  aq.  'n')  or.  (ANSI 
14  call  CLR3CR 

call  QOTQXY(21 , 1 ) 
wrlta(*,272)  NLCHAR 


valua  for  KT--» 


valua  for  KB — > 


valua  for  R--> 


valua  for  L--» 


valua  for  J — » 


valua  for  F--> 


valua  for  KP — » 


valua  for  XV — » 


aq .  ’ R ’ ) )  than 


call  GOTOXYtl,  1) 
writat*. 270) 
raadt*. ' (A)’ )  ANS27 
RELAY  AS  NON-LINEAR  ELEMENT  . . . 

if  ( (ANS27  . aq .  'r')  .or.  (ANS27  ,aq.  'R'))  than 
ELEMNT-1 
NLCHAR- 1  RELAY ' 
call  CLRSCR 
NONLIN-’R’ 


writat  * , 290 )  DBAND 
raadt* , ' (A) 1 )  ANS21 


if  (ANS21  .aq.  'DBAND')  than 
call  GOTOXY (24,1) 

writat*. 1 (A\ ) ‘ ) ‘Entar  a  REAL  valua  for  DBAND--*  * 
raadt*.*)  DBAND 
BO  to  291 

alaaif  (<ANS21  .aq.  'q')  .or.  (ANS21  aq.  '0'))  than 
to  to  14 

alaa 

to  to  291 
andif 

PULSE  WIDTH  MODULATOR  AS  NON-LINEAR  ELEMENT  . . . 

alaaif  ((ANS27  .aq.  ' p ■ >  .or.  (ANS27  .aq.  * P ’  > )  than 
ELEMNT-3 

NLCHAR- 'PULSE  WIDTH  MODULATOR' 

call  CLRSCR 

NOWLIN-'?' 

writat*, 300)  DBAND , PERIOD , KFt*) 
raad(* , ' (A)' )  ANS21 


if  (ANS21  .aq.  'DBAND')  than 
call  GOTOXY  (24,1) 

writat*. ’ (A\ )’) 'Entar  a  REAL  valua  for  DBAND — >  ' 
raadt*.*)  DBAND 
to  to  301 

alaaif  (ANS21  .aq.  'PERIOD')  than 
call  OOTOOCY  (24,1) 

writat* (A\ )•) ’Entar  a  REAL  valua  for  PERIOD--* 
raadt*.*)  PERIOD 
to  to  301 

alaaif  (ANS21  aq  'KPWM' )  than 
call  GOTOXY (24,1) 

writat*, ' (A\ )' )’Entar  a  REAL  valua  for  KPWM--*  ' 
raadt*. •)  KFW1 
to  to  301 

alaaif  ((ANS21  aq,  'q')  or  (AHS21  aq.  ’ Q ’ ) )  than 
to  to  14 

alaa 


i 


to  to  301 


.  SATURATING  AMPLIFIER  AS  NON-LINEAR  ELEMENT  . . . 

alaalf  (CANS27  aq.  ’a’>  .or.  (ANS27  .aq.  'A'))  than 
ELEMNT-2 

NLCHAR-' SATURATING  AMPLIFIER’ 

L  call  CLRSCR 

NONLIN-’A' 

writ# ( * , 280 )  DBAND , KA 
raad{*. ’ (A)’ )  ANS21 

If  (ANS21  aq.  ’ DBAND ’ )  than 
call  GOTOXYC24 , 1) 

writa(»,  ’ (A\ ) '  )  ’Entar  a  REAL  valua  for  DBAND— >  ' 
raad<*,*>  DBAND 
go  to  281 

alaalf  ( ANS21  .aq.  ‘KA’)  than 
call  GOTOXYC  24 , 1) 

writa(*, ’ <A\ )') ‘ Entar  a  REAL  valua  for  KA — »  ’ 
raad(*,*)  KA 
go  to  281 

alaalf  ( (ANS21  .aq.  ’q')  .or.  ( ANS21  .aq.  ’Q’ ) )  than 
go  to  14 

alaa 

go  to  281 
andif 

alaalf  ( (ANS27  .aq.  ’n' >  or.  (AHS27  aq.  ’N’)>  than 
go  to  400 

alaalf  ( ( ANS27  .aq.  ’q')  .or.  ( ANS27  .aq.  ’Q’))  than 
go  to  1 

alaa 

go  to  14 
andif 

Phaaa  Plana  Daalgn  Manu  . . . 
alaalf  ( (ANSI  .aq.  ’p' )  .or.  (ANSI  .aq.  'P'))  than 

call  CLRSCR 

writa(*,260)  EMIN , EMAX , EDMIN , EDMAX 
raad(*, ’ (A) ’ )  ANS21 

if  (ANS21  .aq.  ’EMIN’)  than 
call  GOTOXY(24.1) 

wrlta(*, ' (A\ )') 'Entar  tha  minimum  valua  of  E — »  ’ 
raad(«,«)  EMIN 
go  to  204 

alaalf  (ANS21  .aq.  ’EMAX’)  than 
call  GOTOXY(24 , 1 ) 

writa(* ,’ (A\ )’) ’Entar  tha  maximum  valua  of  E — >  ■ 
raad(V»)  EMAX 
go  to  204 


alsaif  (ANS21  . aq.  'EDMIN' )  than 
call  GOTOXY (21 , 1) 

writaC*, ' (A\ ) * ) 'Entar  the  minimum  value  of  E  DOT-->  ’ 
read<»,*>  EDMIN 
go  to  201 

alsaif  (ANS21  aq.  'EDMAX')  than 
call  G0T0XY(21,1) 

write(* ,’ (A\ ) ‘ ) ‘Enter  the  maximum  value  of  E  D0T--»  ’ 
readC*,*)  EDMAX 
go  to  201 

C  ...  Quit  PHASE  PLANE  Dimeniioning  Menu  . . . 

elaaif  ((ANS21  .aq.  ’q')  .or.  (ANS21  .aq.  ‘Q’))  than 
go  to  1 

alee 

go  to  201 
and  if 
C 

C  ...  Simulation  Option!  . . . 

alsaif  ((ANSI  .aq.  ’o')  .or.  (ANSI  .aq.  ‘0’))  than 
C 

202  call  CLRSCR 
C 

DELTIM-  (FINTIM-BEGTIM)  / ( float ( PTSPLT )*SIM2PL ) 
if  (FINTIM/DELTIM  .gt.  MAXITS)  DELTIM  -FINTIM/MAXITS 
NTERHS-IFIX(FINTIM/DELTIMm 
C 

wr  ite ( * , 210 )  BEGTIM , FINTIM, MAXITS . SIM2PL , PTSPLT . E0 , EDOTO . 
+  RSLOPE , XORG , YORG , WFACT , DELTIM, NTERMS 

raadt*, ' (A)' )  ANS21 
C 

if  (ANS21  .aq.  ‘BEGTIM’)  than 
call  GOTOXY (21,1) 

write{*, ' (A\ )') ‘Enter  a  REAL  value  for  BEGTIM — >  ' 
read(*,*)  BEGTIM 
go  to  202 

alsaif  (ANS21  .aq.  ‘FINTIM’)  than 
call  GOTOXY (21,1) 

writa(*,'(A\)‘) 'Enter  a  REAL  value  for  FINTIM— >  ’ 
read(»,*)  FINTIM 


go  to  202 

alsaif  (ANS21  .aq.  ‘MAXITS’)  than 
call  GOTOXY (21,1) 

write(*,’(A\)‘)  'Enter  a  REAL  value  for  MAXITS— >  ’ 
raad(*,#>  MAXITS 
go  to  202 

alsaif  (ANS21  .aq.  ‘SIM2PL’ )  than 
call  GOTOXY(21 , 1) 

writa(«. ' (A\ ) ‘ ) ‘Enter  a  INTEGER  value  for  SIM2FL — > 
raad(*,*)  SIM2PL 
go  to  202 

alsaif  (ANS21  .aq.  ‘PTSPLT’)  than 
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call  G0TQXY(2<i ,  1) 

writa(*, ’ (A\ ) ' ) ' Entar  a  INTEGER  valua  for  PTSPLT-->  ' 
raad(*,*)  PTSPL1 
if  (PTSPL1  .gt.  1000)  than 
PTSPLT-1000 

alsa 

PTSPLT-PTSPL1 
andif 
go  to  202 

alsaif  (ANS21  .aq.  ' E0 ’  )  than 
call  GOTOXY(2A,1) 

writa(* , ’ (A\ ) ’ ) ' Entar  a  REAL  valua  for  E0  (dagraas)--*  ' 
raad(*.»)  E0 
go  to  202 

alaeif  (ANS21  .aq.  'EDOTO')  than 
call  GOTOXY(24 , 1) 

writa(*, ' (A\ )') ’Entar  a  REAL  valua  for  EDOTO  (dag/sac)--> 
raad(* , *)  EDOTO 
go  to  202 

alsaif  ( ANS21  .aq.  ’ RSLOPE ’ )  than 
call  GOTQXY(24 , 1 ) 

writa(*, '  <A\ )  ’ )  'Entar  a  REAL  valua  for  RSLOPE  (dag/sac)— » 
raad(*,«)  RSLOPE 
go  to  202 

alsaif  (ANS21  .aq.  ‘XORG’ )  than 
call  GOTQXYC24 , 1) 

writa(», ’ (A\ )') ’Entar  a  REAL  valua  for  XORG — »  ' 
raad(*,*)  XORG 
go  to  202 

alsaif  (ANS21  .aq.  'YORG')  than 
call  GOTQXY(24 , 1) 

writs(*. ' (A\ )') ’Entar  a  REAL  valua  for  YORG — >  1 
raad(*,*)  YORG 
go  to  202 

alsaif  (ANS21  .aq.  'WFACT' )  than 
call  GOTQXYC24, 1) 

aritat*, ’ (A\ )’) 'Entar  a  REAL  valua  for  WFACT--*  ’ 
raad<*,«)  WFACT 
go  to  202 

Quit  Simulation  Options  Manu  . . . 
alsaif  (ANS21  .aq.  'Q' )  than 
go  to  1 

alsa 

go  to  202 
and  if 

Sava  Options  to  Fils  ... 

alsaif  ((ANSI  .aq.  's')  .or.  (ANSI  .aq.  'S'))  than 


*•*  OPEN/WRITE/CLOSE  INPUT  DATA  FILE  *•* 
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open ( 7 , FILE-' PHPLANE. IHP1 , STATUS- • NEW ' ) 

writ*(7.1000)  PMODEL , PRTCHR 

writ* (7,1020)  BEGTIM, FINTIM.MAXITS , SIM2PL 

writ*(7, 1022)  KPWM,KV,EO,EDOTO 

writ*(7 , 1024 )  R,L,J,F,KT,KB,KP 

writa( 7 , 1026 )  RSLOPE, PERIOD, DBAND 

writ*(7, 1028)  KA , PTSPLT , XORG , YORG , WFACT 

writa(7 , 1030 )  EMIN , EMAX , EDMIN , EDMAX 

writ*(7 ,2000) 

clo**( 7 , STATUS" ’KEEP’ ) 

go  to  1 

. .  Run  the  Program  . . . 

elsaif  ((ANSI  ,#q.  ’r'>  .or.  (ANSI  .#q.  'R')>  than 
go  to  2 

. .  Quit  tha  Program  . . . 

alaaif  ((ANSI  .aq.  ’q')  .or.  (ANSI  .aq.  ■ Q ’ ) )  than 
atop 

alaa 

go  to  1 
and  if 

. .  Opan  an  Output  Data  Fila  ... 

2  opan(*,flla-'PHPLANE.OUT’ , atatua-’NEW ) 

PI-3. 1*159 
N-.l 

. .  Initialization*  . . . 

NCTR-0 
NPTS-0 
NTIM2-1 
NTIM3-0 
NTIMA-0 
PARG1-0 . 0 
PARG2-0 . 0 
PVAli— 0 . 

CARG1-0 . 0 
CARG2-0 . 0 
OVAL  4—0  . 

TOT 1-0.0 
TOT2-0 . 0 
TV All— 0 . 0 
TVAL2-0 . 0 
TVAL4-0 . 


Fl-0.0 
F2-0 . 0 
•  X3-0 . 0 

WM1-0.0 
WM-0.0 
IM-O. 

IMO-O . 

TSTART-0 . 0 
THEDEG-0 . 0 
TOGGLE- . true . 

PPLANE-0 

KUMBER-0 

NDIM-20 

C 

C  ...  Preliminary  Relationships  . . . 

C  ...  Initial  perturbation  of  THETA  for  stability  check.  (0  otherwise) 
E0RAD-- E0*PI/(180.*N) 

EDOTOR— EDOTO»PI/  ( 180  .  *N> 
if  (KP  .ne.  0.)  WMO-EDOTOR/KP 
X2-MM0 

if  (KP  .ne.  0.)  THETA0-E0RAD/KP 
PTHETA-THETAO 
TAU1-L/R 
TAU2-J/F 
C 

call  CLRSCR 

C  . .  Display  the  simulation  header  . . . 
call  CLRSCR 
call  GOTOXY (10,29) 
write(*,*)  'Simulation  in  Progress’ 

DELTIM-(FINTIM-BEGTIM) / ( float ( PTSPLT)*SIM2PL  > 
if  (FIHTIM/DELTIM  .gt.  MAXITS)  DELTIM  -FINTIM/MAXITS 
NTERMS-IFIX  (FINTIM/DELTIM>+1 
C  ...  Output  Simulation  Options  to  Output  Data  File  . . . 

write!*, 1200)  BEGTIM, FINTIM, MAXITS, SIM2PL, DELTIM, KT, KB, R,L,J,F, 

+  KP , KV , KPWM , KA , RSLOFE 

write(*. 1201)  PERIOD , DBAND , E0 , EDOTO 
C 

call  GOTOXY ( 1* , 1) 
write(* , 15)  DELTIM, NTERMS 

15  formatdSX, 'Simulation  Step  Size  — >  ’.F9.8,'  seconds’,/, 

+  17X, 'Total  Number  of  Steps--*  ’,16) 

call  GOTOXY (21,1) 

C 

if  ((NONLIN  .eq.  'r')  .or.  (NONLIN  .eq.  'R'))  then 
write(*,»)  ’  *•*  NON-LINEAR  ELEMENT  IS  RELAY  ***' 

elseif  ((NONLIN  .eq.  'a')  .or.  (NONLIN  .eq.  ’A’))  then 
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***  NON-LINEAR  ELEMENT  IS  SATURATING  AMPLI 


write(*,*) 

+FIER  ***’ 

elseif  ((NONLIN  .eq.  ' p' )  .or.  (NONLIN  .eq.  ' P’ ) )  then 
writet*,*)  '  ***  NON-LINEAR  ELEMENT  IS  PWM  ***' 

else 

write(*,*)  ■  ***  NON-LINEAR  ELEMENT  NOT  SELECTED  ***' 

writeC*,*)  1  ...  Return  to  Mein  Menu 

PAUSE 
go  to  1 
end  if 
C 

SPACE-DELTIM/2.0 

C 

C  ********************************** 

C  **»  START  MAIN  SIMULATION  LOOP  *«* 

C  **»»»**»****.»*.»*«»»»•***»»»»***» 

C 

DO  100  NTIME-l.NTERMS 
TIME- ( NTIME- 1 ) ‘DELTIM 
NUMIT-0 
THETA-PTHETA 

C 

C  ***********************.*********** 

C  »**  START  INNER  SIMULATION  LOOP  *»* 

c 

200  NUMIT-NUMIT+1 
WM-X2 

C 

THETAF- . 1*THETA*180 . /PI 
OMEGAF- .  1*WM*180  .  /PI 
ORDER-RSLOPE*TIME 
POSERRKJRDER-KP* THETAF -KV*0MEGAF 


.  .  Utilization  of  Non-Linear  Elaoent  . . . 

. .  PULSE  WIDTH  MODULATOR  . . . 
if  ((NONLIN  . aq.  'p')  .or.  (NONLIN  .eq.  ’P'))  then 
call  FWM0D( TIME, NUMIT , TSTART , PERIOD, TOGGLE, POSERR. 

+  DBAND , AGCSAT , AGCCUT , ERRSAT , ERRCUT , VIN , VREF , THRESH , 

+  KFWM) 

.  .  IDEAL  RELAY  . . . 

eleeif  ((NONLIN  .eq.  'r')  .or.  (NONLIN  .eq.  'R'))  then 
call  RELAY (POSERR, DBAND, VIN) 

.  .  SATURATING  AMPLIFIER  . . . 

elaeif  ((NONLIN  eq.  'a')  .or.  (NONLIN  .eq.  ’A’))  then 
call  AMFLIF( POSERR, DBAND, KA, VIN) 

alee 

call  GOTOXY(21, 1) 

write(*,*)  ’  ***  NON-LINEAR  ELEMENT  NOT  SELECTED  ***' 

write(*,*)  ’  ...  Return  to  Main  Menu  . ..’ 

PAUSE 
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•ndif 


C 

EN-VIN-WM*KB 

C 

C  . . .Electrical  Tima  Constant  dua  to  Inductance  Neglected  . . . 

C . »  call  TCONST ( IMO , EN /R, TAU1 , NTIME, NTIM1 .DELTIM, IM) 

IM-EN/R 

TW«IM*KT 

call  TCONST (WMO , TM/ F . TAU2 , NTIME , NTIM2 , DELTIM , HM1 ) 
call  INTGRL (NTIME , NTIM* , DELTIM , THETAO , FVALi , WM1 , CVAL* , TVAL4 . THET 1 ) 
THETA-THET1 

C 

C  ..MM.****...........**.*.**.*....*..*....... 

C  ***  CONVERGENCE  CRITERIA  (Newton's  Method)  *** 

C  **«*•*.«»**••••*«»••»»***••***«***»*•*«**.*«». 

C 

if  (NTIME  .eq.  1).  than 
X3-WM1 
F2-0. 
go  to  ISO 
and  if 
C 

if  (NUMIT  .aq.  1)  than 
F2-(WM1-WM>*1.2 
X3-1.001*V*(1+1.0E-* 

RELERR-abs  (F2/X3 ) 
go  to  310 
and  if 
C 

F2-WM1-VM 

if  (FI  .aq.  F2)  F2-. 999*F2-l.E-8 

if  (X2  ,na.  0.)  RELERR-abs (F2/X2) 

if  (X2  .aq.  0.)  RELERR-1. 

if  (RELERR  .gt.  l.E-8)  than 

X3«X2-F2*(X1-X2)/(F1-F2> 
andif 
310  X1-X2 
X2-X3 
F1-F2 
C 

V*MC2 

C 

if  (NUMIT  .ge.  10)  go  to  150 
if  (RELERR  .gt.  l.E-B)  go  to  200 
C 

C  ••••*••*••**••••••••••••••••••••* 

C  ***  END  INNER  SIMULATION  LOOP  *•* 

c  a**.**.****.*..........,......*.. 

c 

150  call  DERIV( DELTIM , NTIME , NTIM3 , 0 . ,XM1 ,WM1 ,XX ,XDM1 , XD ,XDDM1 , XDD , 


ALPHA) 


C 

X2M*U+ALPHA*0ELTIM 
PTHETA-THETA+WM1 *DELT IM 
THETAF- . 1*THETA*180 . /PI 
OMEGAF- .  1*V*11*1B0  .  /PI 
DIRLOG-VIN/1SO. 

if  (ELEMNT  eq.  1)  THRESH-POSERR 

if  (ELEMNT  .eq.  2)  THRESH-POSERR 

if  (ELEMNT  .ne.  3)  VREF-0 . 

C 

C  ...  Generate  Plotting  Arrays  . . . 
if  (TIME  ge.  BEGTIM)  than 
NCTR-NCTR+1 

if  ( (mod ( NCTR , SIM2PL )  ,aq.  0)  .or.  (NCTR 
NPTS-NPTS+1 

X (NPTS) -CRD ER-KP*THETAP 
Y ( NPTS ) -RSLOPE -KP*0MEGAP 
XTIME(NPTS)-TIME 
Y1 ( NPTS l-POSERR 
Y2(NPTS)-VREF 
Y3 (NPTS  ) -THRESH 
Y4 (NPTS  J-DIRLOG 
andif 
andif 
C 

100  CONTINUE 
C 

C  aaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaa 

C  «**  END  MAIN  SIMULATION  LOOP  *** 

C  a******************************* 

C 

close(4 , status- ’KEEP' ) 

C 

C  ****************************** 

C  *****  Plotting  salaetion  ***** 

C  ****************************** 

c 

C  ***  Clear  Screen  &  Home  Cursor  *** 

400  call  CLRSCR 
C 

write(*, 1305) 
raad(*, * (A) * )  DISOPT 
C 

if  ((DISOPT  .eq.  ‘in’ >  .or.  (DISOPT  .eq.  'M' 
MODEL-99 
IOPORT-99 

alsaif  ((DISOPT  .eq.  ’p’)  .or.  (DISOPT  .eq. 
MODEL-FMODEL 
IOPORT-1 

C  ...  Ioport-9650  is  COM2  .  .  . 


.  aq .  1 ) )  than 


) )  than 


'P'))  than 


»JUK 

1 


m 


u£A 


% 

a 


if  ((MODEL  . «q .  20)  .or.  (MODEL  .eq.  30))  IOPORT-9650 
elseif  ((DISOPT  .eq.  'r')  .or.  (DISOPT  .eq.  'R'))  then 
GO  TO  13 

elseif  ((DISOPT  .  eq.  ’s’)  .or.  (DISOPT  eq.  *  S* ) )  then 


*•*  OPEN/WRITE/CLOSE  INPUT  DATA  FILE 


open ( 7 , FILE-’ PHPLANE . INP‘ , STATUS- *  NEW ■ ) 

writ#(7, 1000)  PMODEL , PRTCHR 

write( 7 , 1020 )  BEGTIM , FINTIM .MAXITS , SIM2PL 

write(  7 , 1022 )  KPVW.KV, E0 , EDOTO 

writ# (7, 102*)  R,L,J,F,KT,KB,KP 

writa(7, 1026)  RSLOPE , PERIOD , DBAND 

writ# (7, 1028)  KA,PTSPLT,XORG,YORG,WFACT 

writ#( 7 , 1030 !  EMIN , EMAX , EDMIN , EDMAX 

writ#( 7 , 2000 ) 

clo*#( 7 . STATUS” 'KEEP1 ) 

go  to  iOO 

aleeif  ((DISOPT  .  #q.  'w’>  .or.  (DISOPT  ,#q.  ’W))  th#n 
.  Printer  ready??  ••• 
call  CLRSCR 
call  GOTQXY (12,23) 

write(*,»)  'PL####  #n#ur#  PRINTER  i#  ready’ 
call  GOTQXY (20, 1) 

PAUSE 

.  Output  Simulation  Option#  to  Printer  . . . 
open(8 ,  file-'pm' , status-'new’ ) 

writ#(8, 1200)  BEGTIM, FINTIM, MAXITS, SIM2PL.DELTIM, 

+  KT,KB,R,L,J,F,KP,KV,KFWM,KA,RSLOPE 

writ#(8, 1201)  PERIOD, DBAND, E0. EDOTO 
writ#(8, 1202) 
format ( ’ 1" ) 

close (8, status"’ KEEP’  ) 
go  to  #00 

•l*#if  ((DISOPT  . #q .  'Q')  or.  (DISOPT  ,#q.  'q'))  than 
GO  TO  *60 

•Is# 

go  to  *00 


call  CLRSCR 

if  ((DISOPT  .eq.  'p')  .or.  (DISOPT  .eq.  ’P’)>  than 
call  GOTQXY(20 , 20 ) 
writ#(*,*>  PRTCHR 
call  GOTOXY (1,1) 


andif 

writ«(*, 1300) 
raad(*, '  (A)1  )  FLOP! 


if  ( (PLOPT  .  aq.  ' Q ’ )  .or  (PLOPT  .  aq.  ’q))  than 
go  to  400 

alaaif  (PLOPT  .aq.  ‘1’)  than 
if  (ELEMNT  .  aq.  2)  KAPW4-KA 
If  (ELMIT  aq.  3)  KAFV*MCFWM 

C 

call  PGRAFH(X,Y,NPTS,EMIN,EMAX,EDMIN,EDMAX,DBAND,KT,KP, 

+  KV, KB , F ,R ,  J ,  ANS27  ,  IOPORT .MODEL ,  KAWM ,  ELQTNT , RSLOPE , 

♦  XORG , YORG . WFACT , PERIOD , DISOPT , BEGTIM ,  FINTIM) 

alaaif  (PLOPT  aq.  '2’ )  than 
If  (ELEMNT  aq.  2)  KAPWhHKA 
if  (ELEMNT  aq.  3)  KAIW^KPVM 
XTITLE-’ TIME  (aac)’ 

XLEN— 10 

if  (ELEMTT  aq.  3)  than 
YTITLE-'PWM  RESPONSE' 

YLEN-12 

alaaif  (ELEMTT  .aq.  1)  than 
YTITLE- 'RELAY  RESPONSE' 

YLEN-13 

alaaif  (ELEMTT  .aq.  2)  than 
YTITLE- 'AMPLIFIER  RESPONSE’ 

YLEN-19 

andif 

C 

if  ((DISOPT  .aq.  ’M’ >  .or.  (DISOPT  aq.  '■')>  than 
call  MIGRAPHC ELEMTT) 

alaaif  ((DISOPT  .aq.  'P')  .or.  (DISOPT  aq.  'p')>  than 
call  MGRAFHt DISOPT, KAPWM , DBAND , XORG, YORG, WF ACT. ELEMNT) 
andif 

alaa 

go  to  410 
andif 
C 

go  to  400 
450  continua 
C 

C  ............................. 

C  ***  I/O  FORMAT  STATEMENTS  ••• 

C  ............................. 

C 

4  format (////,24X, 'REDUCED  ORDER  MODEL  PHASE  PLANE  DESIGN',/, 

+  24X, '  LT  Vineant  S.  Roaaitto,  USN',/, 

+  24X, '  Naval  Poatgraduata  School’,//, 

+  24X , ’  March  1987 ’,//////  ) 

C 

5  format(32X. ’**•  MAIN  MENU  ***'.// , 
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♦  20X,'[H] - »  HARDWARE  Configuration  Manu',/, 

+  20X, ' [M] - >  MOTOR  Paramatar  Manu’,/, 

+  20X, '  [N] - »  NON-LINEAR  Elamant  Salaetion  Manu',/, 

♦  20X,’[P] - »  PHASE  FLAME  Dimensioning  Manu',/, 

♦  20X, ' [03 - >  OPTIONS  for  Simulation’,/, 

♦  20X, ' [S] - >  SAVE  All  Changaa’ ,/, 

♦  20X,'[R] - »  RUN  Simulation  Program',/, 

+  20X, ’ [Q] - »  QUIT  tha  Program’ ,//, 

+  flX, 'ENTER  SELECTION - >’,\) 

105  format ( 30X, '***  HARDWARE  MENU  ***’,//, 

+  20X,’[P] - >  PRINTER/ PLOTTER  configuration  changa’,/, 

+  20X, ' [Q] - >  QUIT  THIS  MENU’ ,//, 

+  8X, ’ENTER  SELECTION - »’,\) 

1000  format ( IX , 13 , 2X, AS0) 

1020  format ( lx, 2F12 . 7 , F12 . 3 , IX , 13 ) 

1022  format  ( IX,  *F15 . 7 ) 

102*  formate IX, 7F8.A) 

1026  format ( IX , 3F1S . 7 ) 

1028  format ( IX, F12 . 7 , IS , IX , 3F12 . 7 ) 

1030  formatOX,  *F12.*) 

2000  formatOX. ’END  OF  FILE’) 

C 

130  FORMAT ( 2*X, ’***  PRINTER  OPTIONS  MENU  ***’,//, 

♦  15X,'[0]  — >  Epaon  FX-80  Printar,  aingla  dansity',/, 

+  15X, ' til  -->  Epaon  FX-80  Printar,  doubla  danalty’,/, 

♦  15X,'[2)  — >  Epaon  FX-80  Printar,  dbla  apd.dual  danalty',/, 

+  15X,’[3]  — »  Epaon  FX-80  Printar.  quad  danalty’,/, 

+  13X,'(*J  -->  Epaon  FX-80  Printar,  CRT  Graphics  I’,/, 

+  15X,’[5)  --»  Epaon  FX-80  Printar,  plottar  graphlca’,/, 

+  15X, ' [6]  --»  Epaon  FX-80  Printar,  CRT  Graphlca  II’,/, 

♦  15X,’[10]  ->  Epaon  FX-100  Printar,  aingla  danalty’,/, 

+  15X,'[11]  -»  Epaon  FX-100  Printar,  doubla  danalty',/, 

♦  15X,’[12]  ->  Epaon  FX-100  Printar,  dbla  apd.dual  danalty',/, 

+  15X,‘03]  -»  Epaon  FX-100  Printar,  quad  danalty’,/, 

♦  15X,'[1*]  ->  Epaon  FX-100  Printar,  CRT  Graphlca  I',/, 

♦  15X, ’ [ 15)  -»  Epaon  FX-100  Printar,  plottar  graphlca',/, 

♦  15X,’[16]  ->  Epaon  FX-100  Printar,  CRT  Graphlca  II’,/, 

+  1SX, ’ [20)  -»  HP  7*70A  Graphlca  Plottar’,/, 

♦  15X, ’ [30]  -»  HP  7*75A  Graphlca  Plottar’,/, 

+  15X, ' [60]  ->  HP  2686A  Laaar  Jat  Printar  (NPS  installation) ',/ , 

+  15X, ' [Q]  --»  QUIT  THIS  MENU’,//, 

♦  3X,'Entar  Printar  Salaetion  Intagar  or  Q  to  QUIT  — >  ’,\) 

C 

230  format(12X, ’*••  MOTOR  PARAMETER  SETTINGS  MENU  •«*’,//, 

♦  *X,F12 . 7, IX, ' [XT]  Motor  Torqua  Conatant',/, 

♦  *X,F12. 7, IX, ' [KB]  Motor  Back  IMF  Conatant',/, 

+  *X,F12. 7 , IX, ' [R]  Motor  Equivalant  Raaiatanca  (ohms)',/, 

+  *X,F12. 7, IX, ' (L)  Motor  Inductanca  (hanriaa) ’ , / , 

♦  *X,F12, 7, IX , ' [ J]  Motor  Inartia  (ox-in/a“2) ’ , / , 

+  *X,F12. 7 , IX, ' [F]  Motor  Viscous  Friction  Coaff’,/, 

♦  *X,F12 . 7 , IX, ’ [KP]  Motor  Position  Faadback  Constant’,/, 
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+  4X.F12. 7 , IX, ’ [KV]  Motor  Velocity  Feedback  Constant’,/. 

♦  17X,’[QJ  QUIT  THIS  MENU’,//, 

+  IX,  ‘Enter  variable  nun*  (UPPERCASE)  or  Q  to  QUIT - »  ',\) 

C 

240  format(12X, '***  SIMULATION  OPTIONS  MENU  »•*’,//, 

+  IX, FIS  .  7 ,  IX, ' [BEGTIM]  Start  Tio*  of  Plotting  Window',/, 

♦  IX , FIS . 7 , IX, 1 (FINTIM]  Stop  Tim*  of  Plotting  Window',/, 

+  1X,F15 . 4 , IX, ‘ [MAXITS]  Max  Number  of  Simulation  Iteration*',/, 

+  13X, 13 , IX, ’ ISIM2PL]  Ratio:  Point*  Simulatad/Pointa  Plotted', /, 

+  12X.I4, IX, * [PTSPLT]  #  of  Point*  par  Curv*  par  Plott lOOOmax) ■ , / , 

+  IX, FIS  7, IX. ' [E0]  Initial  E  Perturbation  Offset  (dag)',/, 

+  1X.F15 . 7  ,  IX, ’ [EDOTO]  Initial  EDOT  Perturbation  Offs*t(d*g/») • , / , 
+  IX, FIS. 7. IX, ’ [RSLOPE]  Ramp  Slop*  (0  for  Stop;  (+)  for  Ramp)',/. 

+  IX , FIS . 7 , IX, ' [XORG]  X  Coordinat*  of  Rafaranc*  Origin',/, 

+  IX, FIS. 7, IX, ’ [YORG]  Y  Coordinat*  of  Rafaranc*  Origin',/, 

+  1X.F15. 7 , IX, * [WFACT]  Plotting  Scaling  Factor  (0.75  nominal)',/, 

+  17X,’tO)  QUIT  THIS  MENU’ ,///, 

♦  15X, ’Computed  *imulation  *t*p  siz*  - >  ’,F8.8,  ’aacond*’,/, 

+  15X, 'Computed  total  number  of  *t*p* - >  ’,16,//, 

+  IX, 'Enter  variable  name  (UPPERCASE)  or  Q  to  QUIT  - >  ' , \ ) 

C 

260  format (///.16X, ’•**  PHASE  PLANE  DIMENSIONING  MENU  ***’,//, 

♦  IX, FIS. 7, IX, ’ I EMIN)  Minimum  E  to  b*  Plotted  on  Grid’,/, 

+  IX, FIS. 7 , IX, ’ [EMAX]  Maximum  E  to  b*  Plotted  on  Grid’,/, 

+  IX,  FIS  7,  IX,  *  (EDMIN1  Minimum  E  DOT  to  be  Plotted  on  Grid’,/, 

+  IX. FIS. 7, IX, ’ [EDMAX]  Maximum  E  DOT  to  be  Plotted  on  Grid’,/, 

+17X,’[Q]  QUIT  THIS  MENU’ ,//, 

+  IX, ‘Enter  variable  name  (UPPERCASE)  or  Q  to  QUIT  - >  ’,\) 

C 

270  format (///.8X, ’***  NON-LINEAR  ELEMENT  SELECTION  *•*’,//, 

♦  10X,’[R]  R*4.ay  (Bang-Bang)',/, 

+10X,'[P]  Pulse  Width  Modulator’,/, 

+  10X,’[A]  Amplifier  (Saturating)’,/, 

+  10X,'(N]  No  Trajectory  Calculation/  Only  Phase  PLANE  Map’,/, 

+  lOX.’lQ]  QUIT  THIS  MENU/RETURN  TO  MAIN  MENU’,//, 

♦  IX, 'Enter  Selection  - »  ’,\) 

C 

272  formatUOX,  'CURRENT  SELECTION  --»  \A30> 

C 

280  format( /// , 8X, SATURATING  AMPLIFIER  SPECIFICATIONS  **•’,//, 

+  IX ,F1S . 7 , IX, ’ [DBAND1  Deadband  Applied  to  System  Feedback’,/, 

+  IX, FIS. 7, IX, ’ [KA]  Amplifier  Gain ’./. 

+  17X,'tQ]  QUIT  THIS  MENU’,//, 

+  IX, ’Enter  the  selection  (UPPERCASE)  - »  *,\) 

C 

290  format( /// , 15X , ’ ***  RELAY  SPECIFICATIONS  ••*',//. 

+  1X.F15 . 7 , IX, ' [DBAND)  Daadband  Applied  to  System  Feedback’,/, 

+  17X,’(Q]  QUIT  THIS  MENU',//, 

+  IX, 'Enter  the  selection  (UPPERCASE)  - »  ’ , \ > 


300  format (/ // , 5X , ' ***  PULSE  WIDTH  MODULATOR  SPECIFICATIONS  ***’,//, 


+  IX ,  F15 . 7  ,  IX , 
+  1X,F15.7,1X, 
+  IX, F15 . 7  ,  IX, 
+  17X, ' (Q) 


[DBAND]  Deadband  Applied  to  System  Faadback',/, 
[PERIOD]  Pariod  of  PWM  Rafaranca  Cycle(aec) ' , / , 

’  IXPWM]  PWM  Amplifiar  Gain' ,/, 


QUIT  THIS  MENU',//, 


+  lX.'Entar  tha  aalaetton  (UPPERCASE)  — » 


,  \ ) 


12C0  format (20X,  LINEAR  MODEL  OF  BRUSHLESS  DC  MOTOR',//, 

♦  IX ,  F 1 5 . 7  ,  IX , 1 [ BEGT IM]  Start  Tima  of  Plottin*  Window’,/, 

+  IX, F 13. 7 , IX, '[FINTIM1  Stop  Tima  of  Plottin*  Window1,/, 

♦  IX ,F15 . * , IX. ‘ [MAXITS]  Mar  Number  of  Simulation  Itarationa' . / , 

♦  13X , 13 , IX . ' (SIM2PL 1  Ratio:  Pointa  Simulated/ Plottad’ , / . 

+  IX, FIS. 9, IX. • [DELTIM]  Simulation  Stap  Sire1,/. 

Motor  Torque  Conatant ',/, 

Motor  Back  EMF  Conatant'./, 

Motor  Equivalent  Raaiatanca  (ohms)',/. 
Motor  Inductance  (henries)1,/, 

Motor  Inertia  (or-in/a*2) ' , / . 

Motor  Viscous  Friction  Coeff’,/, 

Motor  Position  Faadback  Constant',/, 

Motor  Velocity  Faadback  Constant',/, 

PWM  Amplifier  Gain',/, 

Saturating  Amplifier  Gain  (if  used)’,/, 
Ramp  Slope  (0  for  Step:  (+)  for  Ramp)') 
1201  format(lX.F13.7,lX, ' [PERIOD]  Period  of  PWI  Reference  Cycle'./, 

♦  1X.F15  7, IX, ’ [DBAND]  Position  Faadback  Deadband',/, 

♦  1X.F13  7, IX. ' [E0]  Initial  E  Perturbation  Offset  (da*)',/, 

♦  1X.F15.7.1X. ' [EDOTOl  Initial  EDOT  Perturbation  Offset  (da*/a)') 


IX, FIS . 7 , IX, ' [XT] 
1X.F15.7.1X.  '  [KB] 
1X.F15.7  ,  IX,  '  (R) 
1X.F15. 7,  IX,  '  [ L ] 

IX ,  F15 . 7  ,  IX  ,  '  [J] 

IX, FIS.  7,  IX,  ' 

IX. FIS.  7,  IX.  ' 

1X.F15. 7, IX, ' [XV] 

IX, FIS.  7.  IX.  1  [XPWM] 
IX, FIS .  7 ,  IX. ' [XA] 

IX, FIS.  7,  IX,  '  [RSLOPE] 


1  [F] 

’  [XP] 


1203  FORMAT ( IX , F8 . 8 .  IX , 1P3E12 . 3 > 

1300  FORMAT (/////, 2X , *  The  followln*  are  plottin*  options',//, 

♦  5X,'(1]  PHASE  PLANE  Trajectory',/, 

♦  SX, ' [2]  NON-LINEAR  Element  Performance  (PRINT  only)' 

♦  SX.'IQ]  QUIT  THIS  MENU',//, 

♦  2X, ’Enter  selection  [1.2.Q]  - »  ' , \ ) 


/ , 


130S  FORMATt /////, 2X, ‘Display  options:’,/, 

♦  SX,'[M]  MONITOR', /. 

♦  SX, ' [P]  PRINTER' ,/ , 

♦  SX . ' [R]  RETURN  TO  START-UP  MENU  (RE-INITIALIZE) ’ , / , 

♦  SX , ’ ( S ]  SAVE  SIMULATION  SPECIFICATIONS  TO  DISK’,/, 

♦  3X,'[W]  WRITE  SIMULATION  SPECIFICATIONS  TO  PRINTER' 

♦  SX , ' [Q]  QUIT  THE  PROGRAM',//, 

♦  2X . 'Enter  selection  [M, P , R , S , W, Q)  »  ’,\) 


/ , 


1500  format ( IX . 13 , 2X . AS0 ) 


STOP 

END 

C  . 

c  .......................... 

C  .....  PLOTTING  SUBROUTINES 
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yy 


***(  phase-  plana  plot)***** 

Subroutine  PGRAPHCX, Y , NPTS . EMIN . EMAX . EDM IN . EDMAX , DBAND . 

♦  KT,KP,KV,KB,F,R,J,  ANS27  ,  IOPORT  , MODEL , KA , ELEMNT . RSLOPE , 

♦  XORG , YORG.WFACT , PERIOD , DISOPT . BEGTIM, FINTIM) 

implicit  REAL**  (A-Z) 
real**  X( 1010 ). Y( 1010 ) 

inta(ar*2  NPTS , IOPORT , MODEL , XLEM , YLEN . PPLANE , NUMBR  TR , NCHAR . 

♦  NDIM ,  ECTR ,  EDCTR ,  CNTR ,  DBFLAS ,  ELEMfT 
character'l  DISOPT 

character*fi  ANS27 
charecter*2S  XTITLE , YTITLE 
charactar*51  PTITLE 

Patience  Plaaaa  ! ! ' 
call  CLRSCR 
call  GOTOXY (12,27) 

writef*,*)  'Calculating  Data  for  Plot' 
call  GOTOXY (20,11 

DELTAX-  ( DUX  -  EMI  H )  /  6 . 

DELTAY“(  EDMAX-EDMIN )  /6  . 

N-.l 

PI-3.14139 
RA2DEG  -  N-180./PI 


NUMBR-0 

if  (ELEMTT  aq.  1)  than 
ESS— RSLOPE  *KV/KP 

alaalf  ( (ELEMTT  aq.  2)  or.  (ELZMTT  .aq.  3))  than 
E3S-RSL0PE* (F*R*KT*KB+KA*150 . *KT*KV*RA2DEG ) / 

♦  ( KT«KP*KA* 1 50 . -RA2DEG ) 


If  (ELEMTT  .aq.  1)  than 
If  (DBAND  aq  0.)  than 

PTITLE-' PHASE  PLANE  CHARACTERISTICS  (IDEAL  RELAY)' 


alaalf  (DBAND  na  0  )  than 

PTITLE- ’PHASE  PLANE  CHARACTERISTICS  (RELAY  WITH  DEADBAND)’ 


alaalf  (ELEMTT  aq  2)  than 
If  (DBAND  aq  0. )  than 

PTITLE-' PHASE  PLANE  CHARACTERISTICS  (SATURATING  AMPLIFIER) 
PLEN-51 

alaalf  (DBAND  ns.  0  >  than 

PTITLE-' PHASE  PLANE  CHARACTERISTICS  (SAT  AMP  w/  DEADBAND)' 


iVlVi 


7.%V,v 


"v 


and  if 


T  T 

I 

•ajs 

V!» 


alaaif  fFT.FMWT  .  aq.  3)  than 
if  (DBAND  .  aq.  0.)  than 

PT I TLE- 1  PHASE  PLANE  CHARACTERISTICS  (PULSE  WIDTH  MODULATOR)' 
PLEN-51. 

aliaif  (DBAND  .na.  0.)  than 

PTITLE-' PHASE  PLANE  CHARACTERISTICS  (PWM  w /  DEADBAND)' 
PLEN-46. 
and  if 
and  if 

AS  PRAT-. 65 
CHARHT- . 20 

PTX-1 . 5+(6 . -PLEN*ASFRAT*CHARHT ) /2 . 

PTY-7 . *0 

NCHAR-lfix(PLEN) 

CALL  PLOTS ( 0 , IOPORT , MODEL ) 
call  ASPECT(aaprat) 

CALL  FACTOR (WF ACT) 

if  ((DISOPT  .aq.  'M')  .or.  (DISOPT  .aq.  ’m')>  than 
call  PLOTd.O.O.  ,-13) 

.  Draw  a  Bordar  . . . 
call  NEWPENC2) 
call  PLOT(0. .0. ,3) 
call  PLOT ( 6 . , 0 . ,2) 
call  PLOT(8. .8. ,2) 
call  PLOT(0. ,8. .2) 
call  PLOTtO . ,0. ,2) 
call  NEWPENU) 

alaaif  ((DISOPT  .aq.  'P')  .or.  (DISOPT  .aq.'p'))  than 
call  PLOT (XORG/WF ACT . YCRG /WFACT , - 13 ) 

Draw  a  bordar  . . . 

call  PLOT (8.0 /WFACT ,0.0,2) 

call  PLOT (8.0 /WFACT, 6.0 /WFACT. 2) 

call  PLOT (0.0,6. 0/WFACT , 2 ) 

call  PLOTtO. 0,0. 0,2) 

call  PLOT ( 5 . 55 /WFACT , 6 . 0/WFACT , 3 ) 

call  PLOT ( 5 . 33 /WFACT ,0.0,2) 

Spacif ication  Sumaary 

call  SYMBOL (6  35 /WFACT,*  0/WFACT, .28, 'SUMMARY' ,0. ,7) 
call  PLOT ( 6 . 55 /WFACT , 3 . 95 /WFACT , 3 ) 
call  PLOT ( 7 . 3 5 /WFACT , 3 . 93 /WFACT , 2 ) 

if  (RSLOPE  aq  0. )  than 

call  SYMBOL ( 3  7 5 /WFACT ,3.7 /WFACT , . 22 , ’ Typa  of  Input  STEP', 0. .19) 
alaaif  (RSLOPE  na  0.)  than 

call  SYMBOL (3. 7 5 /WFACT. 3. 7 /WFACT, .22. ’Typa  of  Input  RAMP’, 0  .19) 
andlf 

call  SYMBOL ( 5  73/WFaCT , 3  * /WFACT , . 22 , ' Start  Tina  ',0,15) 


call  NUMBER( 999 . ,3. 1/WFACT, . 22 , BEGTIM, 0 . .5) 
call  SYMBOL ( 3 , 75/WFACT , 3 . 1/WFACT, . 22 , ’ Stop  Tima 
call  NUMBER (999. ,3. 1/WFACT, .22, FINTIM.O  ,5) 
call  SYMBOU5. 75/WFACT, 2. 8/WFACT,  .22,  'KP 
call  NUMBER ( 999  .  ,  2 . 8/WFACT, . 22,KF , 0 . ,5) 
call  SYMBOL ( 5 . 75/WFACT, 2 . 5/WFACT ,  22. ’KV 
call  NUMBER(999. .2. 5/WFACT, .22, KV,0  ,5) 
call  SYMBOL (5. 7 5/WFACT, 2  2/WFACT, .22, ’Eaa 
call  NUMBER(999. . 2 . 2/WFACT, . 22 , ESS+DBAND, 0 . ,5) 
if  ((ELDdNT  ,aq.  2)  .or.  (ELEMNT  ,aq.  3))  than 
call  SYMBOL(3 . 75/WFACT , 1 . 9/WFACT , .22, ’GAIN 
call  NUMBER(999. ,1. 9/WFACT, .22. KA,0. ,5) 
and  if 

if  (ELIMNT  . aq.  3)  than 

call  SYMBOL ( 5 , 75/WFACT , 1 , 6/WFACT , . 22 , ’ PVM  Fraq  (Hi) 
call  NUMBER ( 999. ,1. 6/WFACT. . 22 , 1 . /PERIOD, 0 . , 1 ) 


.  Draw  a  Titla 

call  SYMBOL ( PTX, PTY, CHARHT, PTITLE, 0. ,NCHAR) 

Radafina  origin  . . . 
call  PLOTU.  ,1.0, -13) 


CALL  STAXISC. 18, CHARHT.. 10. .080,2) 

CALL  AXIS(0. 0,0.0. ’E’ ,-1.6. , 0 . , EMIN , DELTAX > 

CALL  STAXIS!. 18, CHARHT,. 10.. 080,1) 

CALL  AXIS(0. ,0. , ’E  DOT’ .5,6. ,90. , EDMIN . DELTAY ) 

.  Ganaration  of  Limit  Linat  (Discontinuity) 
if  (XV  .aq.  0  )  than 

.  Poaitiva  Daadband  &  Ralay  Switching  . . . 
L1X1-DBAND+ESS 
L1X2-DBAND+ESS 

L1Y1-EDMIH+(EDMAX-EDMIN ) /float (HD IM) 
L1Y2-EDMAX 

.  Nagativa  Daadband  . . . 

L2X1~-DBAHD+ESS 
L2X2— DBAND+ESS 

L2Y 1-EEMIN+ ( EDMAX - EDMI N )/ float ( NDIM ) 
L2Y2-EDMAX 


if  (XA  .ns.  0 . )  than 
Poaitiva  Saturation  . . 

L3X1-1 . /XA+DBAND+ESS 

L3X2-1  /XA+DBAND+ESS 

L3 Y 1-EDMI N+ ( EDMAX - EDMI N )/ float ( HD IM ) 

L3Y2-EDMAX 


,0  ,15) 


, 0. , 15) 


1  ,0.  ,15) 


Negative  Saturation  . . . 

L*X1— (1  /XA+DBAND)+ESS 
UX2—  ( 1 .  /XA+DBAND  )+ESS 
L4Y1-EDMIN*  (EDMAX-EDMIN )/  float  (NDIM) 
L4Y2-EDMAX 

>ndif 


alaaif  (XV  .na.  0.)  than 

Point  (XI, Yl)  of  Lina  1  ... 
if  ( ( DBAND -EMIN+ESS)*XP /XV  .La.  EDMAX)  than 
L1X1-EMIN+(EMAX-EMIN)/ float (NDIM) 

L1Y1-(DBAND-(IMIN+(IMAX-EMIN> /float (NDIM)  )+ESS)*KP/KV 
alaaif  ( (DBAND-EMIN+ESS)*XP/XV  ,gt.  EDMAX)  than 
L IX 1-DBAND -EDMAX*KV /KP+ESS 
L1Y1-EDMAX 
and  if 

.  .  .  Point  (X2,  Y2)  of  Una  1  .  .  . 

if  ( (DBAND-EMAX»ESS )*XP/XV  ga.  EDMIN)  than 
L1X2-EMAX 

L1Y2-(DBAND-EMAX+ESS)«XP/XV 
alaaif  ( (DBAHD-EMAX+ESS)*XP/XV  ,lt.  EDMIN)  than 

LlX2-DBAND-( (EDMIN+(EDMAX-EDMIN)/float(NDIM) ) )»XV/XP+ESS 
L1Y2-EDMIN+ ( EDMAX -EDMIN ) / float ( NDIM ) 
and  if 

. . .  Point  (XI. Yl)  of  Lina  2  ... 

if  ( ( -DBAND-EMIN+ESS )*KP/XV  .la.  EDMAX)  than 
L2X 1-EMIN+ ( EMAX-IMIN )/ float ( ND IM ) 

L2Y 1- ( -DBAND- <  EMIN+ ( EMAX-IMIN )/ float ( NDIM ) ) +ESS )*XP/XV 
alaaif  ( (-DBAND-EMIN+ESS)*XP/KV  ,gt.  EDMAX)  than 
L2X1— DBAND-EDMAX*XV/KP+ESS 
L2Y1-EDMAX 
and  if 

. . .  Point  (X2.Y2)  of  Lina  2  . . . 

if  < (-DBAND-IMAX+ESS)*XP/XV  .ga.  EDMIN)  than 
L2X2-EMAX 

L2Y2”( - DBAND- EMAX+ESS ) *XP/XV 
alaaif  ( (-DBAND-EMAX+ESS)*KP/KV  .It.  EDMIN)  than 

L2X2— DBAND- ( EDMIN+ ( EDMAX- EDMIN ) / float (NDIM) ) *XV/KP+ESS 
L2Y2-EDMIN+  <  EDMAX-EDMIN ) / float ( NDIM) 
andif 

if  (KA  . na.  0 . )  than 

. . .  Point  (XI, Yl)  of  Lina  3  .  .  . 

if  ( ( 1 . /XA+DBAND -EMIN+ESS )*XP/XV  .la  EDMAX)  than 
L3X1*EMIN+ (EMAX-EMIN) /float  (NDIM) 

L3Yl-( 1 . /KA+DBAND- ( EMIN+ ( EMAX-IMIN )/ float (NDIM) )+ESS ) +XP/XV 
alaaif  ( < 1 . /XA+DBAND-EMIN+ESS)+XP/XV  .gt.  EDMAX)  than 
L3X1-1 . /XA+DBAND-EDMAX+XV/XP+ESS 
L3Y1-EDMAX 
andif 


Point  (X2,Y2)  of  Lina  3  . . . 


if  <(1./KA+0BAND-EMAX+ESS)*KF/KV  g*.  EDMIN)  then 
L3X2-EMAX 

L3Y2-<1. /KA+DBAND-EMAX+ESS)*KP/KV 
elseif  ((l./KA<-DBAND-EMAX+ESS)*KP/KV  It.  EDMIN)  then 
L3X2-1 . /KA+DBAND- (EDMIN+ ( EDMAX -EDMIN )/ float (NDIM) )*KV/KP+ESS 
L3Y2-EDMIN+(EDMAX-EDMIN) /float  (NDIM) 


Point  (XI, Yl)  of  Lin*  *  .  . 
if  ( ( - 1 . /KA-DBAND-EMIN+ESS )*KP/KV  .1*.  EDMAX)  th*n 
LAXl-EMIN+(EMAX-EMIN)/flo*t(NDIM) 

LAYl-(-l. /KA-DBAND-(EMIN+(EMAX-EMIN)/ float (NDIM) )+ESS)*KP/KV 
•l»*if  ((-l./KA-DBAND-EMIN+ESS)*KP/KV  . gt .  EDMAX)  then 
UX1—  1 .  /KA-DBAND-EDMAX*KV/KP+ESS 
LAY1-EDMAX 


.  .  Point  (X2, Y2)  of  Lin*  A  .  .  . 

if  ( ( -1 . /KA-DBAND-EMAX+ESS ) *KP/KV  g*  EDMIN)  then 
LAX2-EMAX 

LAY2-( -1 . /KA-DBAND-EMAX+ESS )*KP/KV 
•l»*if  ( ( "1 . /KA-DBAND-EMAX+ESS )*KP/KV  It.  EDMIN)  th*n 
L4X2— l./KA-DBAND-(EDMIN+(EDMAX-EDMIN)/float(NDIM))*KV/KP+ESS 
L*Y2-EDMIN+(EDMAX -EDMIN) /float (NDIM) 


Point*  ar*  Scaled  to  Real  World  Value* 
Lin*  #1 

L1X1S-(L 1X1 -EMIN) /DELTAX 
L 1 Y IS- ( L x f 1-EDMIN > / DELTAY 
L 1X2S- ( L 1X2-EMIN ) / DELTAX 
L1Y2S-(L1Y2-E0MIR) /DELTAY 


L2X1S-(L2X1-EMIN) /DELTAX 
L2Y1S- ( L2Y 1-EDMIN ) /DELTAY 
L2X2S- ( L2X2 - EMIN )/ DELTAX 
L2Y2S-(L2Y2-EDMIN) /DELTAY 
Lin*  #3 

L3X1S-(L3X1-EMIN) /DELTAX 
L3Y1S-(L3Y1-EDMIN) /DELTAY 
L3X2S-(L3X2-EMIN) /DELTAX 
L3Y2S-(L3Y2-EDMIN) /DELTAY 


LAXIS-(LAXI-EMIN) /DELTAX 
LAYIS-(LAYI-EDMIN) /DELTAY 
LAX2S-(LAX2-EMIN) /DELTAX 
LAY2S-(LAY2-EDMIN) /DELTAY 


if  (ELOWT  .  *q.  3)  then 


Plotting  of  Dashed  Limit  Linas  . . . 
call  STDASH( .05, . 15) 
call  PLOTD (L1X IS , L1Y1S , 3 ) 
call  PL0TD(L1X2S.L1Y2S,2) 
if  (DBAND  .na.  0.)  than 
call  PL0TD(L2X1S .L2Y1S , 3 ) 
call  PLOTD ( L2X2S , L2Y2S , 2 ) 
and  if 

if  ( (ELEMNT  .  aq.  2)  and.  (KA  .na.  0.))  than 
call  PLOTD (L3X IS , L3Y1S , 3) 
call  PLOTD ( L3X2S , L3Y2S , 2 ) 
call  PLOTD (LAX IS , L*Y1S . 3 ) 
call  PLOTD (L*X2S , L*Y2S , 2) 
and  if 

Phase  Plana  Slope  Market  Generation  and  Plotting  . . . 
do  *15  ECTR-l.NDIM 

E”EMIN+((EMAX-EMIN) /FLOAT  (NDIM) ) ‘FLOAT  ( ECTR ) 
do  *25  EDCTR-l.NDIM 
DBFLAG-0 
NUMBR-NUMBR+l 

EDOT-EDMI N+  ( ( EDMAX  -  EDMI H )  /  FLOAT  ( ND IM ) )  ‘FLOAT  ( EDCTR ) 
if  ( aba ( E+EDOT*KV /KP-ESS )  .la.  DBAND)  than 
Deadband  Region  . . . 

if  (EDOT  .na.  0.)  than 
SLOPEX” J  *R*EDOT / DELT AX 

SLOPEY—  (KT*KB+F‘R )  *  ( EDOT-RSLOPE )  /  DELTAY 
alsaif  (EDOT  . aq.  0.)  than 
DBFLAG-1 
SLOPEX-O . 

SLOPEY” 1 . 
and  if 

Positive  Saturation  Region  . . . 

alsaif  ( ( (ELQWT  aq.  1)  .and.  (E+EDOT‘KV/KF-ESS  .gt. 

DBAND) )  .or.  ( (ELEMRT . aq. 2)  .and.  ( ( (E+EDOT*KV/KP-ESS) 

-DBAKD ) ‘KA  .ga.  1.)))  than 

SL0PEX-J»R» (EDOT ) /DELTAX 

SLOPEY— (150. *KT*KP*RA2DEG+ ( KT*KB+F*R ) * ( EDOT-RSLOPE ) ) / 
DELTAY 

Negative  Saturation  Region  . . . 

alsaif  (((ELEMNT  aq.  1)  .and.  (E+EDOT*KV/KP-ESS  .It. 

-DBAND))  .or.  ( (ELEMNT . aq. 2)  .and.  ( ( (E+EDOT»KV/KP-ESS ) 

+DBAND ) *KA  .la.  -1.)))  than 

SLOPEX“J*R* ( EDOT ) /DELTAX 

SLOPEY—  (-150  .  *KT*KF*RA2DEG+  ( KT*KB+F*R )  *  ( EDOT-RSLOPE ) )  / 
DELTAY 

Positive  LINEAR  Region  .  .  . 

alsaif  ( ( ( (E+(EDOT )»KV/KF ) -ESS-DBAND )*KA  .gt.  0.)  .and. 

( ( (E+(EDOT )*KV/KP ) -ESS-DBAND )*KA  .It.  1.))  than 


r  VN 


SLOPEX-J*R* ( EDOT  > /DELTAX 

V- 1 50  * ( (E+ ( EDOT-RSLOPE ) *KV/KP ) -DBAND ) »KA 

SLOPEY— ( V*KT*KP*RA2DEG+ (KT*KB+F*R ) * ( EDOT-RSLOPE ) ) / 

♦  DELTAY 

C  Negative  LINEAR  Region  . . . 

elseif  (<((E+(EDOT)»KV/KP-ESS)+DBAND)*KA  It.  0  )  and. 

+  ( ((E+< EDOT >*KV/KF- ESS )+DBAND)MCA  ,gt.  -1.))  then 

SLOPEX-J-R* ( EDOT ) /DELTAX 
V-150  »< ( E+  ( EDOT-RSLOPE ) *KV /KP ) +DB AND ) *KA 
SLOPEY—  ( V*KT*KF«RA2DEG+ (KT*KB+F*R )  *  ( EDOT-RSLOPE ) )  / 

♦  DELTAY 
endif 

C 

C  ...  Points  are  Scaled  to  Real  World  Coordinates  . . . 

VECLEN-sqrt ( SLOPEX**2+SLOPEY**2) 

EIX-(E-EMIN) /DELTAX 
E2X-E1X+. 15*SL0PEX/VECLEN 
E 1 Y-  ( EDOT - EDMIN ) / DELTAY 
E2Y-E1Y+. 1S-SLOPEY/ VECLEN 
C 

C  ...  Filter  out  end  point  for  ideal  relay  . . . 

if  ((E  .ne.  ESS)  .or.  (EDOT  ns.  0  ))  then 
C  ...  Filter  out  end  points  for  relay  with  Deed  Band  . . . 
if  (DBFLAG  . eq.  0)  then 
call  PL0T(E1X,E1Y, 3 ) 
cell  PLOT(E2X,£2Y,2) 
endif 
endif 

call  SYMBOL (E1X.E1Y , .04,1,0. ,-l) 

C 

425  continue 
415  continue 
C 

if  ((ANS27  . ne .  'n')  .end.  (ANS27  .ne.  'N'))  then 
C  ...  Overlay  a  Phase  Plane  Trajectory  . . . 

X(NPTS+1)-EMIN 

X(NPTS+2)-DELTAX 

Y(NPTS+1)-EDMIN 

Y(NPTS+2> -DELTAY 

call  LINE(X,Y,NPTS, 1,0,0) 

C 

C  ..  Mark  the  Start  of  the  Trajectory  (Real  World  Coordinates)... 
XMARK1-  (X(l)-EMIN) /DELTAX 
YMARX1-  (Y(l)-EDMIR) /DELTAY 
call  SYMBOL (XMARK1, YMARX1 ,.12,0,0.,-1) 

C 

C  ...  Mark  the  Ordered  Position  (Real  World  Coordinates). . . 

XMARK2-  (ESS+DBAND-EMIN) /DELTAX 
YMARK2-  (0. -EDMIN) /DELTAY 
call  SYMBOL (XMARK2.YMARK2, .14,11,0. ,-l) 
endif 


314 


VvV„. 


CALL  PLOTtO. 0,0. 0,999) 


C 

if  (FLAG  .  eq.  X.)  then 
ELEMNT-3 
FLAG-0, 
endif 

C 

C 

RETURN 

END 

C  ******************************** 

C  *****  PLOTTING  SUBROUTINES  ***** 


C  *****(multi-  function  plot) 
C  *****  (Printer  Function) 


c  *******.*.****.****.*******.**** 

Subroutine  MGRAPH  ( D I SOPT  ,  KAPWM ,  DBAND , X0  ,  Y0  ,  WFACT 1 ,  ELEMNT ) 
C 

implicit  REAL**  (A-Z) 

COPMON  XTIME  , Y1 , Y2 , Y3 , Y* , BEGTIM , FINTIM , NPTS , IOPORT .MODEL , 
+  XLEN.YLEN.PLEN.PPLANE.XTITLE.YTITLE.PTITLE 
real**  XTIMEC1010) ,Y1( 1010) ,Y2(1010) ,Y3( 1010) ,Y* (1010) 
integer*2  NPTS , IOPORT , MODEL . XLEN , YLEN , PPLANE , ELEMNT 
character*l  DISOPT 
charactar*3  ANS 
charact#r*20  XTITLE, YTITLE 
character*Sl  PTITLE 
C 

WFACT-(2./3. )*WFACT1 
C  . . .Time  axis  . . . 

XTIME(NPTS+1)-BEGTIM 
FIRSTX  -  BEGTIM 

XTIME  (NPTS+2 ) - ( BEGTIM-FINTIM )/10. 

DELTAX  -  (FINTIM-BEGTIM)/10. 

C 

call  SCALE ( Yl, *., NPTS, 1) 

MINYl-YKNPTS+l) 

DELY1-Y1 (NPTS+2) 
if  (ELEMNT  .ne.  3)  then 
call  SCALE(Y3,5. .NPTS.l) 

MINY3-Y3 (NPTS+1 ) 

DEL Y3-Y3 C NPTS+2 ) 

Y2(NPTS+1)-MINY3 
Y2( NPTS+2) -DEL Y3 
MINY2*+1INY3 
DELY2-DELY3 
else 

Y3  (NPTS+1)— 1.0 
Y3( NPTS+2)-. 2 
MINY3-0 . 

DELY3- . 2 


Y2(NPTS+1)— 1.0 

Y2(NPTS+2)-.2 

MINY2-0. 

0ELY2- . 2 
andif 

Y4(NPTS+1)— 12. 

Y4 (NPTS+2 )“1 . 

CALL  PLOTS (O.IOPORT, MODEL) 

CALL  FACTOR (WFACT) 

if  ((DISOPT  . aq .  'M’)  .or.  (DISOPT  .aq.  'm'))  than 
call  PLOT(2.5.1. ,-13) 

alsaif  ((DISOPT  .aq.  'P')  .or.  (DISOPT  ,aq.  'p'))  than 
call  PLOT (X0 /WFACT , YO /WFACT , -13 ) 

C  . . .  Draw  a  bordar  ... 

call  PLOT (16.0,0.0,2) 
call  PLOT(16. 0,12. 0,2) 
call  PLOTtO, 0,12. 0,2) 
call  PLOTtO. 0,0. 0,2) 

C  . . .  Radafina  origin  . . . 

call  PLOTU. 3, 11.0,-13) 
andif 
C 

CALL  STAXISt .20, .27, .16, .080,2) 

CALL  AXIS(0. 0,0.0, 'TIME  (aac ) * , -10 , 10 . ,270 . .FIRSTX .DELTAX) 

C 

CALL  STAXIS( .20, .27, .16, .080,1) 

CALL  AXIS(0 . , 0 . , ’ERROR  SIGNAL ’ , 12 , 4 . , 0 . , MINY1 , DELY1 ) 

CALL  LINE(Y1,XTIME,NPTS, 1,0,0) 

C 

CALL  AXIS ( S . , 0 . , ' REFERENCE  SIGNAL’ , 16, 5 . , 0 . , MINY2 . DELY2 ) 

CALL  LINE(Y2,XTIME,NPTS, 1,0,0) 

C 

CALL  AXIS(5. ,-10. , 'THRESHOLD  VOLTAGE’ , -17 , 5. , 0 . ,MINY3 , DELY3 ) 
CALL  NEWPEN(2) 

CALL  LINE ( Y3 , XTIME , NPTS ,1,0,0) 

CALL  NEWPEN(l) 

C 

CALL  STAXIS( .20, .27. .13, .080,-1) 

CALL  AXIS ( 11. ,0. , ’DIRECTIONAL  LOGIC’ , 17 ,2 . , 0 . . -1 . , 1 . ) 

CALL  LINE(Y4,XTIME,NPTS, 1,0,0) 

C 

PTITLE“ ’ CLOSED  LOOP  PERFORMANCE’ 

call  SYMBOL ( 14 . 2 , - . 5 , . 38 , PTITLE , 270 . ,23) 

if  (ELEMNT  .aq.  1)  call  SYMBOL! 14 .2, 999 .,. 38, ’  (AMP) ’ , 270 . , 6 ) 

if  (ELEMNT  .aq.  2)  call  SYMBOL( 14 . 2 , 999 . , . 38 , ’  (RELAY ) ’ , 270 . , 8) 

if  (ELEMNT  .aq.  3)  call  SYMBOL! 14 .2 , 999 .  , . 36 ,  ’  (FWM) ’ ,270 . ,6) 

call  SYMBOL(13.6,-1.0, .3, ’GAIN  -  ’,270. .7) 
if  (ELEMNT  .na.  ’2’)  than 

call  NUMBER (13. 6, 999. . . 3 , KAPWM, 270 . ,2) 
alaaif  (ELOKT  .aq.  ’2’)  than 

call  SYMBOL! 13. 6, 999. , .3,236,270. ,+l> 
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call  SYMBOL(13.6,-5.0, .3, 'DEAD  ZONE  -  ' 
call  HUMBER (13. 6, 999. . . 3 , DBAKD , 270 . ,2) 

CALL  PLOT(0. 0,0. 0.999) 

MODEL-99 
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,270. ,12) 


*  PLOTTING  SUBROUTINES  • 
“(multi-  function  plot)* 
‘  (Monitor  Function)  * 


Subroutine  M1GRAPH(ELEMNT ) 


implicit  REAL**  <A-Z) 

COMMON  XTIME , Y1 , Y2 , Y3 . Y* . BEGT IM , FINTIM . NPTS , IOPORT , MODEL , 
+  XLEN , YLEN , PLEN , PPLANE , XTITLE .YTITLE , PTITLE 
real**  XTIME( 1010 ) ,Y1( 1010) ,Y2( 1010) ,Y3( 1010) ,Y* (1010) 
intagar*2  NPTS , IOPORT , MODEL , XLEN , YLEN , PPLANE , ELEMNT 
charaeter*25  XTITLE, YTITLE 
eharacter*5l  PTITLE 

Patience  Plaaaa  !!!  ... 
call  CLRSCR 
call  GOTOXY (12,27) 

write(*.»)  'Calculating  Data  for  Plot’ 
call  GOTOXY (20,1) 


WFACT-.S5 
.Tima  azia  . . . 

CALL  SCALE CXTIME, 10. , NPTS, 1) 

FIRSTX  -  XTIME  ( NPTS+1 ) 

XTIME  ( NPTS+2 ) - ( XT IME  ( NPTS ) -XT IME ( NPTS+ 1 > ) / 1 0 . 
DELTAX  -  XTIME (NPTS+2) 

Y4  (NPTS+1)— 8. 

Y* (NPTS+2 )-l. 

CALL  PLOTS (0, IOPORT, MODEL) 

CALL  FACTOR(WFACT) 

CALL  PLOT(2.5,l. .-13) 


CALL  STAXIS(.18,.23,.10, .080,3) 

CALL  AXIS(0. 0,0.0, XTITLE, XLEN, 10. ,0. , FIRSTX .DELTAX) 

if  (ELEMNT  . ne.  3)  than 
call  SCALE (Y3 , 3 . .NPTS.l) 

MINY3-Y3( NPTS+1) 


•  la1:*  • 


DELY3-Y3 ( NPTS+2 ) 
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Y3(NPTS+l)-0 
Y3 (NPTS+2  )*  2 
MINY3-0. 


CALL  AXIS(10  . 0. , 'ERROR  VOLTAGE' .-13.5. .90  .MINY3 . DELY3 ) 
CALL  LINE (XTIME,Y3,NPTS, 1,0.0) 

Y2(NPTS+1)-MINY3 
Y2 ( NPTS+2 )-D EL Y3 
CALL  STAXISt .18, .23, .10, .080,2) 

CALL  AXIS ( 0  .  ,  0  .  ' REFERENCE  SIGNAL', 16. 5  ,  90  , MINY3 , DELY3 ) 
CALL  LINECXTIME , Y2 , NPTS ,1,0,0) 

CALL  STAXISt . 18, .25, . 10, .080,-1) 

CALL  AXISCO  ,7  , YTITLE , YLEN , 2 . .90. ,-l. ,1. ) 

CALL  LINECXTIME, Y*. NPTS, 1,0,0) 

CALL  PLOTCO. 0,0. 0,999) 
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PULSE  WIDTH  MODULATOR  MODULE 


Subroutine  PWMOD ( TIME , NUMIT , TSTART .PERIOD , TOGGLE , POSERR , 

+  DBAND , AGO SAT , AGCCUT , ERRSAT , ERRCUT , VIN , VREF . THRESH . KPWM ) 

IMPLICIT  RIAL**  (A-Z) 

INTEGER*2  NUMIT, DIR 
LOGICAL*2  WAI TNG .TOGGLE 

Reset  the  ssw-tooth  reference  signsl  . 

If  (TIME  .  ge.  TSTART+PERIOD)  then 
TSTART-TSTART+PERIOD 
TOGGLE* . true . 


If  (POSERR  ,gt  (0  +DBAND )  >  then 


ERROR-ebs (KPWM* ( POSERR -DBAND ) ) 
elseif  (POSERR  It  (0. -DBAND))  then 


ERROR-ebs (KPWM* ( POSERR+DBAND ) ) 


m 


j 


call  LIMIT ( 0. , 1. .ERROR. ERROR) 
call  RAMP (TIME , TSTART , NREF ) 

VREF-NREF/PERIOD 
THRESH-1 . -ERROR 

"WAITING"  la  a  logical  variable  Indicating  whether  or  not  a  new 
pulse  may  ba  generated  . . . 
if  (NUMIT  .  eq.  1)  WAI TNG- TOGGLE 

if  (WAITNG)  than 

if  (VREF  gt.  THRESH)  than 
if  (DIR  eq.  1)  then 
VIN-150. 

TOGGLE-. false, 
alaelf  -(DIR  .eq.  -1)  than 
VIN--150. 

TOGGLE- . falsa . 


elaeif  (VREF  It.  THRESH)  then 


TOGGLE- .  true . 


RELAY  MODULE 


Subroutine  RELAY ( POSERR, DBAND ,VTN) 


implicit  REAL**  (A-Z) 

If  (POSERR  .gt.  DBAND)  then 
VIN-150 

elaeif  (POSERR  .It.  -DBAND)  then 
VIN--150 . 

elaeif  (aba(POSERR)  le.  DBAND)  then 


SATURATING  AMPLIFIER  MODULE 


Subroutine  AMPLIF (POSERR, DBAND , KA, VIN) 


implicit  REAL**  (A-Z) 

if  ( abe ( POSERR)  . la .  DBAND)  then 
VIN-0 . 

eleeif  ((( POSERR- DBAND >*KA  .gt.  0.)  .and. 

*  ( (POSERR-DBAND)*KA  .It.  1.))  then 
VIN-150  .  *  ( POSERR-DBAND  )*KA 

elaeif  < ( ( POSERR+DBAND > *KA  .It.  0.)  .end, 

♦  ( ( POSERR+DBAND ) *KA  .gt.  -1.))  then 
VI N-l 50 . * ( POSERR+DBAND ) *KA 

eleeif  t < POSERR-DBAND )*KA  ge  1.)  then 
VIN-150. 

eleeif  < ( POSERR+DBAND ) *KA  .  le.  -1.)  then 
VIN— 150  . 
endif 

return 

end 


Cutoff-Seturation  Limiting  Subroutine 


Subroutine  LIMIT(RSAT,RCUT . INPUT .OUT ) 
implicit  REAL**  <A-Z) 
if  (INPUT  .le.  RSAT)  then 
OUT-RSAT 

eleeif  (INPUT  .ge.  RCUT)  then 
OUT-RCUT 

elee 

OUT-INPUT 
end  if 


return 

end 


Function  Switch  Subroutine 


£ 


Subroutine  FCNSW(X1 ,X2 ,X3 ,X* ,0UT) 
implicit  REAL**  (A-Z) 
if  (XI  .It.  0.0)  then 
OUT-X2 

eleeif  (XI  eq.  0.0)  then 
OUT-X3 

elee 

OUT-X* 
end  if 


Step  function  Subroutine 


Subroutine  STEPtTIME , TSTEP.OUT) 
implicit  REAL**  (A-Z) 
if  (TIME  ge.  TSTEP)  then 
OUT- 1.0 

elee 

OUT-O . 0 
end  i  f 

return 

end 


*****  Deadspace  Subroutine 


Subroutine  DEADSPt  PI , P2 , VSGDEL , VSGERR) 
implicit  JXAL**  (A-Z) 
if  (VSGDE-  .gt.  P2)  then 
VSGEPR-VSGDEL-P2 
elaeif  (VSGDEL  .It.  FI)  then 
VSGERR-VSGDEL-P1 
elee 

VSGERR-0 . 0 
end  if 

return 

end 


Ramp  Subroutine 


Subroutine  RAMP ( TIME , TRAMP, OUT ) 
implicit  REAL**  (A-Z) 
if  (TIME  .ge.  TRAMP)  then 
OUT-TIME-TRAMP 
elao 
OUT-O . 0 
end  if 

return 

end 


***  TIME  CONSTANT  *** 


Subroutine  TCONST ( YO , X , TAU , KTIME , NTIM , DELTIM , Y ) 
implicit  real**  (A-Z) 
integer*2  NTIME , KTIM 
if  (HTIME  .ne.  KTIM)  YO-Y 


CURVAL  -  NOWVAL 
OUTOLD  -  OUTNEW 
•nd  if 

If  (NTIME  eq .  1)  OUTOLD-IC3 

OUTNEW  -  OUTOLD*(CURVAL+PREVAL)*DELTIM/2. 

NTIM2-NTIME 


rttum 

•nd 


CLEAR  SCREEN  AND  SOME  CURSOR 


subroutine  CLRSCR 
character*l  C1.C2.C3.C4 
integer*2  IC  £  4 ) 

equivalence  (Cl .  IC(1 ) ) .  (C2 .  IC(2) ) .  (C3 ,  ICO  > ) .  (C4 ,  IC(4  ) ) 
date  IC/ 16#1B , 1S#5B . 1&#32, 16*4 A/ 

*  Write  Escape  Code  to  Display  *** 
write(*. 1)  C1.C2.C3.C4 
1  formatf IX, 4A1) 


return 

•nd 


Poaltlon  Cursor  by  Row. Column 


subroutine  (»TaKY(ROW,COU**> 
integer*2  IC(4 ) .ROW.COLUMK ,L 
character*!  Cl ,C2 . C3 ,C8. LC( 5) 
character*}  CBUFF 

equivalence  (Cl , IC( 1 ) ) , <C2 , IC(2 ) ) , (C5 , ICC 3 ) ) . (CB , ICC 4 ) ) 
♦  ( CBUFF , LC ( 1 ) ) 

data  IC/ 18*18, 16#5B. 18#3B, 16*66/ 

L*  10000*1 00  *RCW+COLUMI 

*  Write  Escape  Codes  to  a  Character  Buffer  *** 
wrl tetCBUET , 2 )  L 

2  format (IS) 

*  Write  Escape  Codes  to  Display  *** 

write!*. 3)  C1.C2,LC(2).LC(3).C5.LC(4),LC(5),C8 

3  format! IX. 8A1 , \ ) 


return 
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